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Introduction 


The  objective  of  this  study  was  to  investigate  techniques  for 
improving  missile  and  rocket  test  range  instrumentation.  Specifically, 
a  laser  concept  for  measurement  of  vehicle  position  and  attitude 
originally  proposed  by  Conard  and  Pell  (1,2,3)  was  to  be  exploited. 
Description  of  the  concept. 

The  concept  has  been  described  in  detail  elsewhere  (4,5,6);  how¬ 
ever,  a  description  will  be  included  here  for  completeness. 

Two  ground-based  laser  tracking  stations  are  required.  Typically 
these  stations  incorporate  a  pulsed  laser,  transmitter,  and  detector 
optics  all  situated  on  an  elevation  over  azimuth  mount.  The  return  signal 
from  the  vehicle  must  generally  be  enhanced  through  the  use  of  conventional 
corner  cubes,  reflective  tape,  or  paints  located  on  the  vehicle.  Such 
devices  are  current  technology,  typfied  by  the  Precision  Automated 
Tracking  System  (PATS) .  In  the  following  presentation  it  is  assumed  that 
the  tracker  will  provide  the  space  position  of  the  vehicle.  In  order  to 
determine  attitude,  each  of  the  ground  stations  is  additionally  equipped 
with  a  continuous  wave  laser;  and  two  roof  prisms  are  located  onboard 
the  test  vehicle.  For  vehicles  exhibiting  roll  rates  equal  to  or 
greater  than  the  desired  attitude  data  rates,  the  prisms  are  simply 
inlet  into  the  surface  of  the  round  at  the  convenient  location  (e.g., 
dummy  warhead).  In  the  development  which  follows,  we  will  assume  that 
this  is  the  case. 

Consider  the  90-deg  roof  prism  shown  in  Fig.  1.  For  this  appli¬ 
cation,  the  two  surfaces  which  are  shown  crosshatched  are  silvered.  Two 
lines  emanating  from  the  center  of  each  silvered  surface  and  perpendicular 
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such  that  the  plane  of  the  reflector  contains  the  roll  axis  of  the 
vehicle.  Two  coordinate  systems  will  be  u.ilized  as  shown  in  Fig.  2. 

The  Earth-fixed  system  is  defined  with  the  origin  located  at  the  launch 
point;  positive  Z  axis  in  the  vertical  upward  direction;  positive  Y 
axis  in  the  downrange  direction;  and  the  X  axis  in  the  crossrange 
direction  to  provide  a  right-handed  system.  A  vehicle-centered  system 
is  defined  with  the  origin  located  at  the  intercept  of  a  plane  bisecting 
the  90-deg  prism  and  the  vehicle's  roll  axis.  The  cj  axis  coincides  with 
the  roll  axis  of  the  vehicle,  positive  toward  the  nose;  n  perpendicular 
to  to  and  parallel  to  the  XY  plane,  positive  toward  the  positive  X 
direction;  and  £  perpendicular  to  to  and  n  to  form  a  right-hand  ortho¬ 
gonal  system.  The  components  of  the  position  vectors  of  the  ith 
ground  station  and  the  vehicle  in  the  Earth-fixed  system  are  (X-^,  Y^, 

Z.)  and  (X  ,  Y  ,  Z  ),  respectively.  Using  the  transformation  matrix 
1  m  m  m 

between  the  two  systems,  the  components  of  the  ith  ground  station  in  the 
vehicle-centered  system  are 

rv=cos(62)  (Xi-Xm)  -sin(62)  (Y.-YJ  (la) 

(Di=sin(62)cos(5i) (Xi-Xm)+cos(62)cos(61) (Yi~Ym)  +sin  (6 j  )  (Z^-Zm)  (lb) 

E .=-sin(6  )sin(6  ) (X  -X )-cos(6  )sin(6  ) (Y  -Y  ) 
l  l  lim  Z  iim 

+cos(6  )(Z.-Z  )  (lc) 

1  1  m 

where  6^  and  6^  represent  the  geometric  pitch  and  yaw,  respectively, 
defined  as  in  Fig.  2a.  Referring  to  Fig.  2b,  it  may  be  seen  that  the 


time  interval  between  pulses  returned  to  the  i  and  j  ground  station  is 

1  £•  S, 

Atij=  —  [arctan (  —  !-)-arctan( — J-)  ]  (2) 

ni  "j 

Note  that  substitution  for  the  ^  and  tk  using  Eq.  (1)  yields  an  equation 
in  terms  of  relative  position  of  the  stations  and  the  vehicle,  and  the 
geometric  pitch  and  yaw.  A  third  ground  stations  could  be  used  to  provide 
a  similar  relationship  yielding  two  equations  and  two  unknowns  ( 6  ^ ,  'S 2 ) 
where  it  is  assumed  that  the  relative  positions  are  obtained  from  the 
laser  tracker,  and  the  roll  rate  is  inferred  from  pulses  returned  to  a 
single  station.  Unfortunately,  simultaneous  solution  of  these  two 
equations  is  relatively  insensitive  to  yaw  variation  for  reasonable  third 
station  locations  and  suffers  the  disadvantage  of  requiring  three  ground 
stations. 

INCLINATION 
ANGLE 


A  NGJL  AR 
SE  PARATION 


PLANE  OF 
REFLECTOR 


Fig.  3  Vehicle  equipped  with  two  prisms. 


4 


Consider  now  the  addition  of  a  second  roof  prism  to  the  vehicle, 
as  indicated  in  Fig.  3,  with  an  angular  separation  of  6  relative  to  the 
first  reflector  and  a  skew  of  y.  The  geometry  of  the  prisms  is  shown 
in  more  detail  in  Fig.  4.  Assume  that  the  tx  the  plane  of  the  straight 
retroref lector  passes  through  the  ith  ground  station.  As  the  vehicle 
continues  to  roll  the  plane  of  the  second  reflector  eventually  passes 
through  the  same  ground  station  at  t2*  It  is  apparent  from  the  figure 
that  the  vehicle  must  roll  a  distance  6+0  so  that  the  time  interval 
between  the  two  pulse  receptions  is  At^  =  (l/ft)  (6+0-^). 

Figure  4  also  indicates  that  tan  =  R/B^  and  tan  y=C^/B^. 

Therefore,  0.j=arcsin  (tany)  /  (tanc^)  .  By  noting  that 

tan  ai=  (pi2+Ci2)'5/wi 

one  obtains  the  result 

.  w^tany 

Atii  =  „  6  +  arcsin[(-(--^-y)%)]  (3) 

which  can  be  expressed  in  terms  of  6^and  62  using  Eqs.  (1). 

This  equation  is  very  similar  to  the  Yawsonde  formulation  because 
both  approaches  involve  the  relationship  of  planes,  fixed  with  respect 
to  the  vehicle,  relative  to  a  remote  point.  The  Yawsonde  approach 
differs  from  the  concept  presented  here  in  as  much  as  it  involves  on¬ 
board  detectors  and  telemetry.  Equations  (2)  and  (3)  may  be  solved 
numerically  for  6jand  S2  assuming  once  again  that  ft,  Xi~Xm  .  Yi-Ym, 
Zi-Zn,,  At  12  are  known. 

Unfortunately,  a  closed  form  solution  of  these  two  equations  could 
not  be  found.  The  problem  was  reformulated  to  achieve  a  closed  form 
solution  as  explained  in  the  next  section. 
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In  this  equation  the  carat  (')  denotes  a  vector  of  unit  magnitude 
and  |r£  -  rm|  denotes  the  magnitude  of  the  vector  difference  between  r^ 
and  rm. 

A  retroreflection  plane  may  be  defined  as  a  plane  within  which  a 
light  signal  transmitted  to  the  missile  is  returned  to  the  place  of 
emission.  A  unit  normal  which  defines  the  plane  of  retroreflection 
currently  passing  through  ground  station  (i)  may  be  defined  as  eT^, 
where  is  physically  interpretable  as  a  unit  vector  lying  along  the 
intersection  of  two  mirror  surfaces  placed  90°  apart. 


Fig.  5  Definition  of  e  . 

T 1 

We  define  a  skewness  angle  a  as  the  angle  between  eTi  and  a  normal 

A  A  A  A 

to  the  roll  axis  (eni)  when  Exi,  eu,  and  eni  are  all  coplanar  and  which 
allows  for  mounting  the  mirrors  skewed  relative  to  the  roll  axis. 


Fig  6.  Definition  of  a 


The  angle  between  er^  and  ew  is  the  tracking  aspect  angle  a^. 

^ri  *  Cy  =  sin  oi  enl  (5) 

The  angle  between  the  two  ground  stations  as  taken  from  the  missile  is 

defined  as  p. 

erl  "  ^r2  =  cos  ^12  (6) 

The  retroreflection  plane  is  assumed  to  pass  through  ground  station 
1  at  time  tj.  It  passes  through  station  2  at  time  t2  =  tj  +  t12. 

Between  these  two  times,  the  retroreflection  plane  has  rotated  through 
an  angle  o)At12  where  u  is  the  constant  roll  rate  of  the  missile. 


Ground  station  1 

Fig.  7  Geometric  relationship 


In  order  to  determine  the  angle  of  rotation,  we  must  define  a  unit 
vector  eAi  that  lies  in  the  plane  of  retroreflection  with  station  i, 
but  is  perpendicular  to  the  roll  axis  It  is  necessary  that  eA1  be 

»  A  A 

a  linear  combination  of  vector  eri  and  This  e^i  is  found  using  the 

form 


eAi 


x  eT 

I  e  u  x  eTT 


(7) 


Now  that  all  angles  and  vectors  needed  to  find  the  aspect  angles  a. 

have  been  found,  we  may  define  exi- 

_  .  -  .  cos  a  -  *  ... 

eTi  =  -sina  ew  +  --  eri  x  (8) 


Using  equations  (7)  and  (8),  and  the  fact  that 

| e^  x  cTi |  =  |  sin  (90  +  a) |  =  cos  a  (9) 

we  arrive  at 

1 

£Ai  =  teri  "  cos  0i  c*]  (10) 

As  previously  mentioned,  the  angle  of  roll  that  the  missile  has  ex¬ 
perience  between  retroreflecting  station  1  and  2  is  ioAti2»  The  vectors 
and  eA2  must  also  have  undergone  this  same  angular  change  so  that 
EA1  eA2  =  cos  (“At  12) 

Using  equation  (10)  twice,  we  see  that 
cos  (uAti2)  =  CAl  ‘^A2 

=  — j - z - [eri  -  cos  o,  e.J  •  [cr2  -  cos  00  e,,l 

sin  01  sin  02  i  l  1 

sin  sxn02  w  rz 

-cos  02  eri  .  eu  +  cos  o^  cos  02  eu  •  e^] 
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**  — j — - - — —  [cos  Vm  -  cos  a,  cos  a- 

sin  sin  02  1  2 

-cos  02  cos  +  cos  cos  02] 

=  — j - — — j - —  [cos  Hi 2  -  COS  01  cos  Oo]  (12) 

sin  01  sin  a2  1  2 

With  equation  (3)  written  in  the  form 

Cii  "  a  [B  +  arcsin  («)]  (13) 

Equations  (12)  and  (13)  can  be  solved  simultaneously  for  o^  and  O2 
in  closed  form.  The  two  aspect  angles  can  be  used  to  determine  the 
orientation  of  the  longitudinal  axis  of  the  vehicle  thereby  providing 
vehicle  attitude.  A  solution  alogorithm  has  been  implemented  in  program 
ASP11  which  is  documented  in  Appendix  I.  Input  data  for  ASP11  includes 
ground  station  locations,  missile  position,  roll  rate  and  measured  time 
intervals. 

In  order  to  obtain  an  accurate  missile  position  in  range  coordinates 
from  the  data  tape  generated  by  LAMPAMS  a  second  program  was  developed. 
Vehicle  position  determination 

Data  tapes  generated  by  the  LAMPAMS  are  in  binary  form,  9  rrack, 

800  bpi.  The  data  arrangement  on  the  tape  is  shown  in  Fig.  8  .  In 

order  to  generate  accurate  position  information  the  azimuth,  elevation 
and  range  recorded  on  the  tape  in  binary  form  are: 

1.  Transformed  to  based  10. 

2.  Corrected  for  bias. 

3.  Smoothed  with  a  running  10  point  least  squares  polynomial. 

4.  Transformed  to  range  coordinates. 
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Fig.  8  LAMP AMS  magnetic  tape  format 


\ 

A  program  (LTPOS)  has  been  written  to  accomplish  these  tasks  and  a 
listing  is  included  as  Appendix  II.  This  program  was  initially  developed 
to  run  on  the  central  computer  at  the  U.S.  Army  Missile  Command  (CDC  6600) 
in  anticipation  that  this  is  where  the  data  analysis  would  be  done.  Sub¬ 
sequently,  the  program  was  adapted  to  run  on  the  Hewlett  Packard  1000 
System,  which  was  installed  on  the  test  range  at  Redstone  Arsenal. 

An  additional  program  to  determine  tracker  bias  based  on  measurements 
of  surveyed  points  equipped  with  retroref lectors  was  acquired  from  Yuma 
proving  ground  and  adapted  to  run  on  the  central  computer  at  Redstone. 

This  program  has  been  partially  converted  to  run  on  the  Hewlett  Packard 
system;  however,  this  has  not  been  completed.  Because  of  the  length  of 
the  program  overlay  techniques  are  required  and  considerable  additional 
software  development  will  be  required  to  accomplish  this  task. 

Application  to  non-rolling  vehicles 

The  approach  evolved  for  testing  non-rolling  or  slowly  rolling  vehicles 
involves  spinning  a  portion  of  the  dummy  warhead  up  to  relatively  high  rates 
prior  to  launch  and  simply  allowing  it  to  spin-down  during  flight.  In 
order  to  demonstrate  the  approach,  twelve  2.75  inch  rocket  fuses  were  re¬ 
worked  as  shown  in  Figure  9  and  provided  to  MICOM  for  use  in  flight  tests. 

Design  of  a  pre-spin  device  was  coordinated  with  MICOM  personnel  and  a 
unit  was  fabricated  at  MICOM. 
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0.75  in.— - 1 .5  in. 


Reworked  2.75  inch  fuse 


Status  of  the  LAMPAMS 


The  LAMPAMS  system  was  installed  on  Range  1  of  Redstone  Arsenal 
in  the  spring  of  1978.  Since  that  time  the  tracker  portion  of  the  system 
has  become  the  primary  instrument  for  vehicle  position  determination. 

The  program  LTPOS  originally  provided  to  MICOM  has  served  as  the  basis  for 
data  reduction.  It  has  been  extensively  revised  by  MICOM  personnel  to 
include  graphical  output. 

Unfortunately,  the  CW  laser  and  signal  conditioning  hardware  assoc¬ 
iated  with  the  attitude  subsystem  have  been  subject  to  repeated  failures 
and  as  of  September  1979  no  attitude  data  has  been  generated. 

Since  both  the  pulsed  laser  used  for  tracking  and  the  CW  laser  on  the 
attitude  system  operate  at  the  same  frequency  the  data  must  be  separated 
on  the  basis  of  pulse  width  in  software.  In  addition,  the  potential  for 
missing  a  return  pulse  from  the  attitude  subsystem  is  higher  than  that 
associated  with  the  tracking  system.  The  software  package  required  to 
determine  appropriate  time  intervals  for  use  in  ASP11  has  not  been  com¬ 
pleted  because  of  these  uncertainties  and  the  lack  of  data  to  resolve  the 
areas  in  question. 

Conclusions  and  Recommendations 

Determination  of  vehicle  attitude  using  the  concept  described  re¬ 
quires  two  laser  ground  stations.  Presently,  only  one  station  i  avail¬ 
able.  The  concept  can  however,  be  verified  using  a  single  ground  station. 
Every  effort  should  be  made  to  get  the  attitude  subsystem  of  LAMPAMS  oper¬ 
ational  so  that  the  required  software  can  be  completed,  The  efficacy 
of  the  concept  could  then  be  verified.  This  should  be  completed  prior  to 
acquisition  of  a  second  laser  ground  station. 
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Appendix  I 
ASP11 

Program  to  determine  attitude 
of  vehicle 

(Hewlett  Packard  System  1000  version) 


THE  MAIN  PROGRAM 


The  main  program  exists  to  call  the  proper  input  subroutine  for  reduction 
of  input  values  to  pitch  and  yaw  angles.  It  also  sets  the  input/output 
device  numbers,  the  maximum  allowable  error,  the  constant  ir,  and  the 
number  of  degrees  per  radian. 

Currently  the  main  programcalls  only  one  other  program  segment, 

SUBROUTINE  INPUT. 


SUBROUTINE  INPUT 

The  subroutine  provides  an  interactive  method  of  operating  the  rest 
of  the  program.  Sixteen  commands  give  versatility  and  ease  to  changing 
any  or  all  of  the  parameters  involved  in  a  pitch  and  yaw  determination. 

The  subroutine  prompts  the  user  for  required  input  of  the  various 
parameters.  As  an  added  check,  the  values  fed  in  after  a  prompt  are 
displayed  to  the  user.  If  any  doubt  remains  as  to  what  variables  the 
program  is  using,  a  command  is  available  to  display  the  current  values 
of  all  variables. 

The  first  time  through,  the  user  is  prompted  to  input  all  the  necessary 
variables  for  a  computation  of  pitch  and  yaw.  After  all  variables  are  input, 
a  prompt  for  a  command  is  printed.  At  this  point  fifteen  possible  commands 
are  available: 

RUN  -  will  determine  the  pitch  and  yaw  using  the  current  variables 

A  RETURN,  with  nothing  entered  -  does  the  same  as  RUN 

DISPLAY  -  displays  a  list  of  all  current  variables 


provides  a  list  of  command: 


available  and  what  they  do 


GSI  -  will  change  the  coordinates  of  Ground  Station  One 


GS2  -  changes  Ground  Station  Two  coordinates 


MISSILE  -  changes  missile  coordinates 
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DT11  -  changes  the  time  difference  for  the  two  mirrors  to  retroreflect 
through  ground  station  one 

DT12  -  changes  the  time  difference  for  one  mirror  to  retroreflect  through 
ground  station  one,  and  then  ground  station  two 
BETA  -  changes  the  radial  separation  between  the  two  mirrors  on  the  missile 
SKI  -  changes  the  skewness  of  mirror  set  one 
SK2  -  changes  the  skewness  of  mirror  set  two 
OMEGA  -  changes  the  roll  rate  of  the  missile 

RESTART  -  starts  an  entirely  new  case  where  all  variables  must  be  reentered 
STOP  -  halts  the  execution  of  the  program  when  you  are  finished 
Any  command  may  be  input  after  the  prompt  "COMMAND",  and  in  any  order, 
iega,  the  roll  rate,  may  be  input  in 
RAD  -  radians  per  second 
RPS  -  revolutions  per  second 
RI’M  -  revolutions  per  minute 
DPS  -  degrees  per  second 

ie  program  converts  the  input  value  into  radians  per  second. 

When  INPUT  encounters  a  RUN  command,  or  a  blank  command,  subroutine  SOLVE 
called  to  determine  the  pitch  and  yaw  angles. 

SUBROUTINE  SOLVE 

SOLVE  is  the  organizer  for  the  solution  of  pitch  and  yaw  angles.  It  calls 

TUP  to  calculate  the  geometric  relationships  between  the  ground  stations  and 

'77 

e  missile.  Next,  SIGH  is  called  to  determine  the  first  aspect  angle.  SIG12 
subsequently  called  to  find  what  the  other  aspect  angle  is.  ESUBW  is  then 
lied  to  find  the  correct  roll  axis. 

SOLVE  always  returns  to  INPUT. 
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SUBROUTINE  SETUP 


SETUP  determines  R1 ,  R2,  £R^ ,  and  £R2-  Unit  vector  £Rj  is  parallel 
to  Rl.  The  magnitues  R1  and  R2  are  determined,  as  is  COSMU  which  is  the 
cosine  of  the  angle  between  Rl  and  R2 . 

SUBROUTINE  SIGH 

Using  the  time  necessary  for  both  sets  of  missile  mirrors  to  retro- 
ref  lect  through  ground  station  one  (DT11) ,  and  the  yawsonde  equation,  the 
first  aspect  angle  SIGMA1  is  determined. 


SUBROUTINE  SIG12 

The  time  required  for  one  mirror  to  retroreflect  through  ground  station 
one  and  then  ground  station  two  (DT12) ,  when  used  in 

cos(nAt,„)  =  — - - — ; - [cosp  -  cosoi  coso 9 ]  (1) 

12  sinoi  smo2  x  z 

where:  Q  =  OMEGA,  the  missile  roll  rate  in  radians  per  second 

Ati2  =  DT12 

cosy  =  COSMU 

cosoq  =  cos(SIGMAl) 

sino!  =  sin(SIGMAl) 

determines  two  possible  SIGMA2  aspect  angles.  SIGll  provides  SIGMA1  (o^)  , 
SETUP  provides  COSMUy(cos  ),  so  that  02  may  be  determined  explicitly. 

Two  roots  become  possible  for  02.  These  are  SIG2A  and  SIG2B.  To 
further  complicate  matters,  we  only  accept  angles  that  are  0  _<_  02  tt. 

When  the  arctangent  function  is  used,  a  negative  argument  may  represent 
either  -02  or  -rr/2  -  02 • 
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These  difficulties  were  circumvented  by: 

1)  replacing  a  02  <  0  by  ff/2  -  02,  hence  making  02  positive 

2)  testing  the  resultant  a 2 A  and  c^g  to  see  if  equation  (1) 
is  satisfied. 

When  the  subroutine  returns  to  SOLVE,  ISOL  contains  the  integer  number 
of  solutions  which  satisfy  (1).  If  ISOL  =  0,  no  solution  is  possible,  and 
SOLI  =  S0L2  =  0,  an  arbitrary  default  value.  If  ISOL  =  1,  the  correct  sol¬ 
ution  is  in  SOLI.  If  ISOL  =  2  the  two  solutions  are  in  SOLI  and  S0L2. 

SUBROUTINE  ESUBW 

When  two  aspect  angles  are  given,  the  roll  axis,  £w  (ESUBW)  may  be 
determined  by  the  solution  of: 

SRI  ‘  Sw  =  cos(ai) 

SR2  ’  Sw  =  cos(02)  (2) 

Sw  ’  Sw  =  1 

Equations  (2)  are  nonlinear,  and  therefore  not  easily  solved.  The 

method  used  in  this  program  determines  the  i  component  of  ew,  or  e^. 

This  reduces  (2)  to: 


e 

R1S 

ER1Y 

ER1Z  ^ 

(  cos(o]  )' 

ER2X 

£R2Y 

ER2Z 

£ 

xy 

= 

cos (a 2) 

1 

0 

0  1 

^  CWZ  1 

l  Ewx  / 

Equation  (  3)  is  linear,  and  easily  solved  with  a  SIMultaneous 
eQuation  solver,  SIMQ.  With  the  roll  axis  known,  pitch  and  yaw  are  easily 
determined  by: 

YAW  =  ARCTAN  (ewx/exy) 

PITCH  -  ARCTAN [ewx/(cwx2  +  ^wy2)^ 

The  three  cases  which  are  impossible  to  solve  using  this  formulation 


20 


are 

Case  I  criy  =  eR2Y  =  0 

Case  II  eRlz  =  eR2z  =  0 

Case  III  £Ri  =  K  £r2  where  K  is  a  real  number 
Case  III  physically  corresponds  to  the  missile  being  located  between 
the  two  ground  stations  along  a  vecotr  connecting  the  ground  stations. 

Cases  I  and  II  reduce  equation  (3)  to  an  overdeterminant  set  which 
may  be  solved  for  and  ewz,  and  ewx  an^  ewy  respectively,  as  a  system 
of  two  equations  in  two  unknowns.  The  remaining  component  may  be  found  by 

ewx2  +  Ewy2  +  ewz2  =  1  (5) 

The  main  difficulty  would  be  the  determination  of  This  is 

done  in  subroutine  ESUBWX. 

It  is  important  to  note  that,  given  two  aspect  angles,  there  are  two 
possible  roll  axes.  To  determine  the  correct  roll  axis,  subroutine  TIME 
is  called.  When  TIME  is  given  a  roll  axis,  it  determines  the  two  time 
differences  DELT11  and  DELT12  from  previous  work.  If  the  two  computed 
time  differences  are  within  the  allowable  error  limit,  then  the  roll  axis 
is  valid,  otherwise  it  is  not. 


SUBROUTINE  ESUBWX 

ESUBWX  explicitly  determines  from  equation  (2) .  There  are  gen¬ 
erally  two  solutions  These  reside  in  R00T1  and  R00T2.  Occasionally 

the  two  roots  are  redundant,  then  ISOL,  the  number  of  solutions  is  one. 

If  gRl  and  gR2  are  linearly  dependent,  then  ISOL  =  0  as  no  solution  is 
possible. 

In  the  solution  of  e^,  a  quadratic  equation  of  the  form 

(1  +  B2  +  D2)e2wx  +  2 (AB  +  CD)exw  +  (A2  +  C2  -  1)  =  0  (6) 


21 


is  recurrent.  The  values  of  A,  B,  C  and  D  vary  depending  on  the  vectors 
£R1,  £r2 »  and  the  values  of  cos(a^)  and  cos  (02).  Subroutine  QUADRA  solves 
quadratic  equation  (6)  given  A,  B,  C,  and  D. 


SUBROUTINE  QUADRA 

QUADRA  solves  equation  (6)  given  A,  B,  C  and  D.  If  the  radical 
resulting  is  less  than  zero,  ISOL  =  0,  and  no  solution  is  possible  because 
the  two  roots  would  be  complex.  This  corresponds  to  two  non-intersecting 
aspect  angle  cones.  If  ISOL  =  1,  one  solution  is  the  same  as  the  other. 

This  corresponds  to  two  tangent  cones.  Typically  ISOL  =  2,  and  two  solutions 
for  £wx>  R00T1  and  R00T2,  exist. 

SUBROUTINE  SIMQ 

Given  an  N  by  N  matrix  [A],  and  a  vector  [B]  (N  x  1),  SIMQ  solves 
the  matrix  equation 

[A]  [X]  =  [B]  (7) 

for  [X],  a  vector  that  is  N  x  1.  During  the  course  of  computation,  [A] 
and  [B]  are  destroyed. 

A  possible  alteration  to  speed  computation  would  be  to  use  Cramer's 
rule  for  the  solution  of  [X]  instead  of  the  current  Gauss  elimination  procedure. 


SUBROUTINE  TIME 

TIME  calculates  DELHI  and  DELT12  when  given  a  roll  axis  and  all 
geometric  constants. 

Pitch  and  yaw  are  determined  from  equations  (/j).  An  alternate  co¬ 
ordinate  system  is  defined  as 


A  possible  alteration  to  speed  computation  would  be  to  use  Cramer's 


rule  for  the  solution  of  [X]  instead  of  the  current  Gauss  elimination  pro¬ 
cedure. 

SUBROUTINE  TIME 

TIME  calculates  DELT11  and  DELT12  when  given  a  roll  axis  and  all 
geometric  constants. 

Pitch  and  yaw  are  determined  from  equations  (4) .  An  alternate  co¬ 
ordinate  system  is  defined  as 

Hi  =  cos (YAW)  RXi  -  sin(YAW)RY±  (8) 

u>i  =  sin (YAW)  cos (PITCH) RX±  +  cos (PITCH) RY1  +  sin (PITCH) RZi 
Ci  =  sin (YAW)  sin(PITCH)RXi  -  cos(YAW)  sin (PITCH)RYi  + 
cos (PITCH) RZi 
times  are  found  by 

DELHI  =  — {BETA  +  ARCSIN  [u^  TAN(SKEW1)/(E;l2  +  r^2)^]}  (9) 

DELT12  =  — ARCTAN  (e^/r^)  -  ARCTAN  (e2/n2)] 

where  OMEGA  is  the  foil  rate  of  the  missile  in  radians  per  second 
BETA  is  the  angular  separation  of  the  mirrors  in  radians 
SKEW1  is  the  skewness  of  mirror  one 

If  both  of  the  DELT  times  are  within  the  allowable  error  tolerance 


of  the  initial  times  given,  then  the  pitch  and  yaw  values  are  output. 


000!  FTN4.L 

0002  PROGRAM  ASP l I 

0003  DOUBLE  PRECISION  XI ,  Y1 , Z1 ,  X2.  Y2 , Z2 ,  XM.  YM.ZM, SXEWI , 

0004  1  SKEV2, BETA, RXI , RY1 , RZ1 , R1 , RX2 , RY2 , RZ2 , R2, COSHU, XR1 , 

0003  2  YTU  , ZR1 , XR2, YR2.ZR2, ANSWER, P I , RADIAN , 

0006  3  ERROR. EWX, EOT, EOT 

0007  INTEGER  OUTPUT 

0008  COMMON  XI , Y1 ,ZI , X2 , Y2 , Z2 , XM, YM, ZM.SKEWl , 

0009  1  SKEW2, BETA, RXI , RY1 ,RZI .III , RX2, RY2 , RZ2, R2, COSNU, XR1 , 

0010  2  YR1 , ZR1 , XR2 , YR2 , ZR2 , ANSWER!  4,6) , P I , RAD  IAN, 

0011  3  ERROR,  EWX,  EOT,  EWZ ,  NUNSOL ,  NREAD ,  OUTPUT 

0012  DIMENSION  IPRAIK 5) 

0013  CALL  RUPARl  IP  RAH) 

0014  NUNS0L=0 

0015  NREAD= I PRAIK  1 ) 

0016  OUTPUT=  IPRAIK2) 

0017  P I  =  4 .  DO  f-DATAIK  1 .  DO ) 

0018  R4DIAN= 180.D0/PI 

0019  ERR0R=l.D-5 

0020  CALL  INPUT 

002 1  STOP 

0022  END 
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0023 
0024 
0023 
0026 
0027 
0028 
0029 
0030 
0031 
0032 
0033 
0034 
0033 
0036 
0037 
0030 
0039 
0040 
0041 
0042 
0043 
0044 
0045 
0046 
0047 
0048 
0049 
0050 
0051 
0052 
0033 
0054 
0055 
0056 
0057 
0053 
0059 
0060 
0061 
0062 
0063 
0064 
0065 
0066 
0067 
0068 
0069 
0070 
0071 
0072 
0073 
0074 
0075 
0076 
0077 
0078 
0079 
0000 
0081 
0082 
0083 
0004 
0083 
0006 
0037 
0083 
0089 
0090 
009  1 


SUBROUTINE  INPUT 

DOUBLE  PRECISION  DTU.DT12 

DOUBLE  PRECISION  BETA  I N ,  SKEW  1 1 ,  SKEW2 1 

DOUBLE  PRECISION  OMEGA, OIIEGI N, P ITCII, YAW 

DOUBLE  PRECISION  XI ,  Y1  ,Z1 , X2,  Y2, Z2,  XII,  YM, ZM.SKEWl , 

1  SKEW2 ,  BETA ,  RX 1 ,  RY 1 ,  UZ 1 ,  III ,  RX2 ,  IIY2 ,  RZ2 ,  H2 ,  COS  MU ,  XR I , 

2  YR1 ,  ZIll ,  X112 ,  YR2 ,  ZR2 ,  ANSWER,  P I ,  RAD  I  AN , 

3  ERROR, EWX, EWY,  EWZ 
INTEGER  OUTPUT 

COMMON  XI ,  Y1 ,  Z 1 .  X2 ,  Y2 ,  Z2 ,  XII,  YM,  ZM.  SKEW I , 

1  SKEW2 ,  BETA ,  RX  1 ,  RY1 ,  RZ 1 ,  R1 ,  RX2 ,  RY2 .  IIZ2 ,  R2 ,  COSMU,  XR1 , 

2  YR1 , ZR1 , XR2 , YR2 , ZR2 , ANSWER! 4,6) , PI, RADIAN, 

3  ERROR.  EWX.  EWY,  EWZ,  NUfISOL ,  NllEAD ,  OUTPUT 
INTEGER  ICOim 32) 

DATA  IC0NT/2IIGS,  2H1  ,2IIGS,2H2  ,  2I1MI ,  2KSS ,  2HDT,  2H 1 1 , 2IIDT, 

1  2H12, 2IIBE, 2IITA, 2HSK, 2H1  ,2HRU,21IN  ,2H  ,2H  ,2RST,2nOP, 

2  2HD 1 , 2HSP ,  2ESK,  2H2  ,  2II0M,  2IIEG,  21IRE,  2IIST,  211?  ,2H  ,2HS0, 

3  2in.U/ 

DATA  IRAD1 ,  IIIPS2,  IRPM2,  IDPS 1/2IIRA,  2IIS  ,2HM  ,2UDP/ 

5  KFLAG=0 

10  WRITE!  OUTPUT,  100) 

100  FORMAT!  "  INPUT  GROUND  STATION  1  COORDS:  X,Y,Z") 

READ ( NREAD , * ) XI , Y1 , Z 1 

WRITE!  OUTPUT,  10 1 ) XI , Y1 , Z1 

1 0 1  FORMAT! 1 P3  (  2X , D20 .  15)) 

IF(KFLAG.NE.O)  GOTO  300 

20  WRITEC OUTPUT, 102) 

102  FORMAT!  "  INPUT  GROUND  STATION  2  COORDS:  X.Y.Z") 

READ(  IIREAD ,  * )  X2 ,  Y2 ,  Z2 

WRITE!  OUTPUT,  10  1 )  M2 ,  Y2 ,  Z2 
IFCKFLAG.NE.G)  GO  TO  300 
30  WRITE(  OUTPUT, 103) 

103  FORIIATl  11  INPUT  MISSILE  COORDS:  X.Y.Z") 

READ!  NREAD, *) XH, YM, ZII 

WRITE (  OUTPUT,  101)  XII,  YM,  ZM 
IF(Kl'LAG.NE.O)  GO  TO  300 
40  WRITE!  OUTPUT, 104) 

104  FORMAT! “  INPUT  DELTA  T  11,  IN  SECONDS " > 

READC  NREAD,:.':)  DTI  1 

WRITEC OUTPUT,  103) DTI  1 
IFCKFLAG.NE.O)  GO  TO  300 
105  FORMAT!  2X, 1PD23. 15) 

50  WRITEC OUTPUT, 106) 

106  FORMAT! "  INPUT  DELTA  T  12,  IN  SECONDS") 

READC NREAD, *> DTI 2 

WRITEC OUTPUT, 103)  DT12 
IFC KFLAG. NE. 0)  GO  TO  300 
60  WRITEC OUTPUT, 107) 

107  FORMAT! “  INPUT  THE  RADIAL  SEPARATION  OF  MIRRORS  IN  “ 

1  “DECREES") 

READC  IIREAD,  *)  DETAIN 
BETA* BETA  I N/RAD  I AN 
WRITEC OUTPUT, 103) DETAIN 
IFCKFLAG.NE.O)  GO  TO  300 
70  WRITEC OUTPUT, 108) 

108  FORMAT! "  INPUT  THE  SKEW  ANGLE  OF  MIRROR  1,  IN  DEGREES") 

READC  NREAD, *) SKEW1 I 

SKEW 1= SKEW 1  I/RADIAN 
WRITEC  OUTPUT, 105)SKEW1I 

no  FoiuLvrc / *  when  you  wish  to  change  something,  or  run"/ 

1  “  THE  PROG. ,  THEN  FOLLOW  THE  LIST  BELOW"/ 

2"  GS1= GROUND  STATION  ONE  COORDINATES"/ 

2"  GS2- GROUND  STATION  TWO  COORDS.  "/“  HISSILE*MISSILE  COORDS. "/ 
4“  SKI* SKEW  OF  MIRROR  1"/"  SIC2=SKEW  OF  MIRROR  2"/“  RUN=COMPUTE" 


5/"  NO  ENTRY.  .JUST  A  RETURN ,  WILL  EXEC  THE  PROG"/"  STOP-" 

6 “HALT  OF  EXECUTION "/ ”  BETA- RAD I AL  SEPARATION  OF  THE  MIRRORS"/ 


7"  DISPLAY* CURRENT  VALUES  OF  ALL  VARIABLES"/) 


IFCKFLAG.NE.O)  GO  TO  300 


WRITEC OUTPUT, 109) 
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0092 

0093 

0094 

0095 

0096 

0097 

0090 

0099 

0100 

0101 

0102 

0103 

0104 

0105 

0106 

0107 

0108 

0109 

0110 

0111 

0112 

0113 

0114 

0115 

0116 

0117 

0110 

0119 

0120 

0121 

0122 

0123 

0124 

0125 

0126 

0127 

0128 

0129 

0130 

0131 

0132 

0133 

0134 

0135 

0136 

0137 

0130 

0139 

0140 

0141 

0142 

0143 

0144 

0143 

0146 

0147 

0140 

0149 

0150 

0151 

0152 


109  FORMAT!  “  INPUT  TIIE  SKEW  ANGLE  OF  MIRROR  2,  IN  DEGREES ") 
READ!  NREAD ,  * )  SICEW2 1 
SKEW2= SKEW2 1 /RAD  I  AN 
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1 14 

1 15 

1 

2 

3 

4 


116 

1 


111 

300 

112 


301 


113 

91 

73 

74 
1 19 

1 

1 17 

1 


VII 1 TE  ( OUTPUT .  1 03 )  S  ICE  V2 1 
1  F(  ICFLAG.  NE.  0)  CO  TO  300 
WRITE! OUTPUT, 115) 

READ!  NREAD ,  * )  OflEG  I N 

READ!  II READ ,  1  12)  IUNIT1,  IUNIT2 

FORMAT! 2X, D23 . 15 , 2A2) 

FORMAT!  "  INPUT  THE  ROLL  RATE,  SKIP  A  LINE. "/ 

"  AND  THEN  RAD  FOR  RADIANS  PER  SECOND"/ 

“  RPS  FOR  REVOLUTIONS  PER  SECOND"/ 

•  RPM  FOR  REVOLUTIONS  PER  MINUTE"/ 

“  DPS  FOR  DEGREES  PER  SECOND") 

OMEGA1 0 . DO 

IF!  IUNIT1.EQ.  I  RADI )  OTIECA=OMEGIN 
IF!  IUNIT2. EQ.  I R1’S2 ) OMEGA* 2 .  DO:* P I *OMEG I N 
IF!  IUNIT2.EQ.  1RPM2) OMEGA*  1 20 . BO*P I *OMEG I N 
IF!  IUNIT1.EQ.  I  DPS  1 )  OMEGA=OIIEGIN/RADI  AN 
IF!  OMEGA. Ed. 0. DO)  GO  TO  9 1 

WRITE! OUTPUT. 1 16)0tlEGIN. IUNIT1 . IUNIT2, OMEGA 
FORMAT!  “  YOUR  “ 1PD16 . 10, 2X.2A2 "CONVERTS  TO"F16 . 10" 
"  SECOND") 

KFLAG= 1 

IF!  ICFLAG.  EQ.O)  WRITE!  OUTPUT,  110) 

FORMAT!  "  COMMAND " ) 

WRITE!  OUTPUT, 111) 

READ!  NREAD,  112)  ICOIIl ,  I  COM2 
FORMAT!  2A2) 

IFLAG=0 


RADIANS  PER 


DO  301  1=1,  16 

IF! ICONT!  2*1-1) . EQ. ICOIIl. AND. IC0NT!2*I) . EQ. IC0M2) IFLAG= I 
CONTINUE 

IF! 1FLAG.EQ.0)  WRITE!  OUTPUT, 113) 

IF!  IFLAG.EQ.O)  GO  TO  300 
FORMAT!  *  EH?") 


GO  TO! 10,20,30.40,50,60,70,80,80,90,200,71,72,5,73,74) , I FLAG 
WRITE! OUTPUT, 1 13) 

GO  TO  300 
WRITE! OUTPUT, 110) 

GO  TO  3C0 
WRITE!  OUTPUT, 1 17) 

DO  119  I NT= 1 , NUHSOL 

WRITE! OUTPUT, 1 18) I NT, ANSWER!  INT, I) ,, ANSWER!  INT,2)  , ANSWER!  INT.3) 
, ANSWER! INT, 4) , ANSWER!  INT.3) , ANSWER!  I NT. 6) 

FORMAT!  / "  SOLUTION  PITCH  YAW  TIME1 1  TIME12" 

"  ERR! 1  ERR12 "/> 


118  FORMAT!  2X,  15 , 2F 10. 5 , 2X,  2F 10. 6 , 2D  10 . 4) 

GO  TO  300 
90  RETURN 

80  CALL  SOLVE! PITCH, YAW, OMEGA, DTI  1 .DT12) 

CO  TO  300 

200  WRITE!  OUTPUT, 201) XI , Y1 ,Z1 ,X2, Y2.Z2, XM.YM.ZM, DETAIN, SICEW1 1, 

1  SKEW2 I , DT 1 1 , DTI 2 , OMEGA 

20 1  FORMAT!  "  STAT ION  ONE : “ 2! D 1 6 . 9 " , “ ) D 1 6 . 9/ "  STAT I ON  TWO : " 

12! D16.9", ")D16.9/"  MISSILE: "2! D16 . 9 “ , " ) D16 . 9/ "  BETA= "1)16 . 9 ”  DEG 

2  ,  "  REES  "  / "  SKEW  1  =  "  D 1 6 . 9  "  DEGREES  “  / "  SICEW2  =  "  D 1 0 . 9 "  DEGREES  "  , 

3  /"  DELTA  T  11= "DIO. 9“  SECONDS"/"  DELTA  T  12= ", 

4  D16.9"  SECONDS"/"  OMEGA= "D16 .9 "  RADIANS  PER  SECOND"/) 

GO  TO  300 

END 
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0174 

0175 

0176 

0177 

0178 

0179 


G  SI MO  SOLVES  THE  MATRIX  EQUATION  A  TIMES  X  EQUALS  B 
C  EOR  T1IE  VECTOR  X 

C  GIVEN  ARE  TIIE  N  BV  N  MATRIX  A.  AND  TOE  VECTOR  B. 

C  WIEN  KS=0,  A  VALID  SOLUTION  IS  GIVEN 
C  WIEN  KS=1,  TOE  MATRIX  A  IS  SINGULAR 
SUBROUT IRE  SI KQ( A , B . KS ) 

DOUBLE  PRECISION  A(  3 , 3) , B< 3) , DETA, DETB, DETC, DET 
KS=0 

DET=  AC  1, !)*( A(2,2)*A(3,3>-A(2.3)*A<3,2))- 

1  A(  1.2>*<A(2, 1 ) *A(  3,3)-A(2,3)*A(3,  1))  + 

2  A(  l ,  3)  *(  A(  2 ,  1 )  *A(  3 , 2)  -A<  3 ,  l)*A<2,2)) 
IF(DET.EQ.O.DO)  ICS=  1 

I F(  DET. EQ . 0 . D3 ) RETURN 

DETA=  B(  1  >  *(  A<  2 . 2)  »AC  3 , 3)  - A(  2 . 3)  * A<  3 . 2) )  - 

1  A( 1 , 2) *<  B( 2) "At  3, 3)- A( 2. 3) *B(  3) )  + 

2  A(  1,3>*(B(2)S:A<3,2)-B(3>*A(2.2)) 

DETB=A(  1 , 0*(B(2)*A(3,3)-A(2,3)SB(3)  )- 

1  B(  1>*(A(2,  1)  ::\<3,3)-A(2,3): .  A(3.  1))  + 

2  A(  1.3>*<A(2.  1 ) :SB(3)-A(  3.  1 ) ^BC  2)  ) 

DETC=A(  1.  1 )  *(  A(  2, 2)  :-B(  3)  -B(  2)  *A(  3.2))- 

1  A( 1 ,2)*(A(2. 1 ) *BC  3) -B(  2) *AC  3 . 1) )  + 

2  B(  1>*< A<2,  1 )  «A(  3 , 2)  -  A(  3 ,  1)*A(2,2) ) 

B(  1 )  =  DETA/DET 

B(  2) = DETB/ DET 
B( 3)  =  DETC/DET 
RETURN 
END 
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0  100 
0101 
0102 
0103 
0104 
0103 
0106 
0187 
0103 
0109 
0190 
0191 
0192 
0193 
0194 
0193 
0196 
0197 
0190 
0199 
0200 
0201 
0202 
0203 
0204 
0203 
0206 
0207 
0200 
0209 
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021  1 
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0213 
0214 
0215 
0216 
0217 
0210 
0219 
0220 
0221 
0222 
0223 
0224 
0225 
0226 
0227 
0220 
0229 
0230 
0231 
0232 
0233 
0234 
0235 
0236 
0237 
0230 
0239 
0240 
0241 
0242 
0243 
0244 
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0246 
0247 
0240 
0249 
0230 
023  1 
0232 
0233 


C  E  SUB  W  IS  TIIE  ROLL  AXIS  OF  THE  MISSILE.  GIVEN  TOE  TWO  ASPECT  ANGLES 
C  TO IS  ROUTINE  WILL  DETERMINE  TIIE  ROLL  AXIS  UNIT  VECTOR 
C  AS  WELL  AS  TIIE  PITCH  AND  YAW  FOR  THE  PARTICULAR 
C  CASE  IN  QUESTION 

SUBROUT I  HE  ESUBWC  S I GMA 1 , S I CMA2 , OMEGA , DT 1 1 , DT 1 2  > 

DOUBLE  PRF.C  I S I  ON  I)T  1  1  ,  DT  1 2 

DOUBLE  PRECISION  SIGMA1  ,  SIGMA2 

DOUBLE  PREC I S I ON  OMEGA , ROOT 1 , R00T2 

DOUBLE  PRECISION  BELT 1 1 , DELT 1 2 , COSS 1 , C0SS2 , DET 

DOUBLE  PRECISION  XI ,  Y1 , 7 1  ,  X2 ,  Y2,  Z2 .  XII,  YH,  ZM,  SKEW1 , 

1  SKEV2.  BETA,  RX1 ,  UY1  ,RZ1 ,  IU  , RX2 , RY2 , RZ2 , 112,  COSMU.XRl, 

2  YR1 ,  ZIll ,  XR2 ,  YR2 ,  ZR2 ,  ANSWER,  P I ,  RAD  I  AN, 

3  ERROR, EWX.EWY.EWZ 
INTEGER  OUTPUT 

COMMON  XI ,  Y1  ,Z1  .  X2.Y2.Z2.XM,  YM.ZM.SKF.Wl , 

1  SKEW2, BETA, RX1 , RY1 , RZ1 , R1 , RX2 , RY2 , RZ2 , R2 , COSMU , XR1 , 

2  YR1 .  ZR1  ,  >312 ,  YR2 ,  ZR2 .  ANSWER!  4 , 6  >  ,  P  I  ,  RAD  I  AN , 

3  ERROR, EWX, EVY, EWZ, IIUM30L, BREAD, OUTPUT 
DOUBLE  PRECISION  AA( 3,3) , A( 3 , 3) , B( 3) , C( 3) 

IF( YR1 . EQ. YR2. AND. YRI . EQ. 0 . DO)  GO  TO  90 
1FC ZR1 .  EQ. Z112 .  AND.  ZR1 .  EQ.  0 .  DO)  GO  TO  95 
AA( 1, t)=XRl 

AA( 2 , 1) =XR2 
AAC  3 , 1 ) = 1 . DO 
AAC 1 , 2) =YR1 
AA(  2, 2)  =  YR2 
AAC  3, 2) =0 . DO 
AAC 1 ,3) =ZR1 
AAC  2, 3) =ZR2 
AAC  3 , 3) =0 . BO 

CALL  ESl/XC  S I  GMA  1 ,  S I GMA2 ,  ROOT  1 ,  R00T2 ,  ISOL,  DTI  1 ,  DT12) 

IFC 1S0L.CT.0)  GO  TO  10 
WRI TEC  OUTPUT, 20) 

RETURN 

20  FORMATC "  **N0  SOLUTION  AVAILABLE  FOR  TOE  ROLL  AXIS**"/' 

1  ■  **ESWX  DID  NOT  RETURN  A  VALUE  TOR  EWX**"/') 

10  C03SI=DC0SCSICMA1) 

C0SS2=  BCOSC  S  ICMA2) 

CC 1)=C0SS1 
CC  2) =CCSS2 
C  C  3 )  =  ROOT 1 
DO  1000  1=1,3 
BC  I >  =GC  I) 

DO  1000  J= 1.3 
1000  AC  I , J ) =  AAC I , J) 

CALL  SI HOC AA.C.KS) 

IFC  KS. EQ. 0)  GO  TO  00 
WRITEC  OUTPUT, 40) 

40  FORMATC"  ***ERROR  IN  SIMQ,  TOE  MATRIX  FOR  FINDING  THE"/ 

1  "  ROLL  AXIS  IS  SINGULAR*****") 

RETURN 
30  EWX=CC 1 ) 

EWY=CC  2) 

EWZ=CC  3) 

CALL  T I MEC DELT 1 1 , DELT 1 2 . OMEGA , DT 1 1 . DT 1 2 ) 

IFC DA3SCDELT1 1-DT1 1 ) ,GT. ERROR)  GO  TO  50 
IFC DACSC DELT12-DT12) ,GT. ERROR)  GO  TO  50 
RETURN 

50  IFC ISOL. EQ. 1)  RETURN 
BC  3 )  =  R00T2 
CALL  SIKQC A.B.KS) 

IFCKS.EQ.O)  GO  TO  60 
WRITEC OUTPUT,  40) 

RETURN 
60  EVX=BC  1) 

EW-EC2) 

evz=  nc  :i ) 

CALL  TIMEC  DELT1 1 , DELT12 . OMEGA. DTI  1 .DTI2) 

IFC  DABSC  DELT1 1-DT1 1 ) . GT. ERROR)  GO  TO  70 
IFC  DA3SC  DELT12-DTI2) . CT. ERROR)  GO  TO  70 
RETURN 

70  WRITECOUTPUT.nO) 

00  FORMATC"  **ESUBW**THERE  IS  NO  SUITABLE  ROLL  AXIS**") 

«  RETURN 
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0272 
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0276 

0277 


C  YR1=YR2=0.D0 

90  DET=XR1*ZR2-XR2*ZR1 

IF!  DET.NE.0.D0)  GO  TO  91 
WRITE!  OUTPUT, 93) 

93  FORMAT!  "  **R1  AND  R2  ARE  NOT  LINEARLY  INDEPENDENT**  V 

1  “  NO  SOLUTION  POSSIBLE*****") 

RETURN 

91  COSS  1  =  BC0S!  S IGIIA1) 

C0SS2=  DCOS (  S 1 GI1A2 ) 

EWX= !  COSS 1 *ZR2-ZR 1 *C0SS2 ) /DET 
EWZ=  !  XIU*C0SS2-XR2*C0SS  1 )  /DET 
EWY=D3QRT!  1 .  D0-EWX**2-EWZ**2) 

RETURN 

95  COSS 1= DCOS! SIGMA1) 

C0SS2=  DCOS!  S IGMA2) 

DET= XR1 * YR2- YR 1 *XR2 

IF! DET.NE.O.DO)  GO  TO  96 
WRITE!  OUTPUT, 93) 

RETURN 

96  EWX= ! COSS 1 * YR2- YR 1 *C0SS2 ) /DET 
EI<Y= !  XRI*C0SS2-XR2*C0SS  1 )  /DET 
EWZ=DSQRT! 1 . D0-EKX#*2-EWY**2J 
RETURN 

END 
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027a  C  SIGMA  1  IS  DETERMINED  BY  THE  YAVSONDE  EQUATION  IN  THIS  ROUTINE 
0279  SUBROUTINE  S IG1K OMEGA, SIGMA1 , DT11) 

0280  DOUBLE  PRECISION  DT11.DTAN 

0281  DOUBLE  PRECISION  OMEGA, A. ALPHA. S IGMA1 

0282  DOUBLE  PRECISION  XI ,  Y1 , Z1 . X2 . Y2 . Z2 , XM, YM, ZM, SKEW1 , 

0283  I  SKEK2 ,  BETA ,  RX I .  IlY  1 ,  RZ 1  ,  II 1  ,  R.'{2 ,  RY2 ,  RZ2 ,  R2 ,  COSMU ,  XR1 , 

0284  2  YR1 ,ZR1 ,XR2,YR2.ZR2, ANSWER, PI, RADIAN, 

0283  3  ERROR, EWX, EWY, EWZ 

0286  INTEGER  OUTPUT 

0287  COMMON  XI , Y1 , Z1 , X2, Y2.Z2, XM, YM, ZM.SKEWl , 

0280  1  SKEV2, BETA, RX1 , RY 1 , RZ1 , R1 . RX2 , RY2 , RZ2 , R2, COSMU, XR1 , 

0209  2  YR1  ,  ZRl ,  XR2 ,  Y112  ,ZR2 ,  ANSLERI  4,6)  ,  P  I  ,  RADIAN , 

0290  3  ERROR, EWX, EWY, EWZ, NUMSOL, NREAD, OUTPUT 

029 1  A= DATAMt SKEW2) /DAT AN ( SKEW1 ) 

0292  ALPHA=  OMEGA*  DT 1 1  -BETA 

0293  S1GHA1  =  DAT AIR  ( DTAN(SKEWl) *DSQRT( 1 . D0+ A*A+2 . DO*A*DCOS(  ALPHA) 

0294  1  ) ) /DS IN( ALPHA) ) 

0295  IF( SIGMA1 . LT. 0. DO) S IGMA1=SIGMA1+P I 

0296  return 

0297  END 


0298  C  TOE  FOLLOWING  CALCULATES  TIIE  SOLUTION  OF  SIGMA  2  FROM 

0299  C  THE  ONE  PRISM,  TWO  GROUND  STATION  FORMULATION 

0300  SUBROUTINE  SIC12( OMEGA, S IGMA1 , DT12 . SOLI ,S0L2. ISOL) 

0301  DOUBLE  PRECISION  DT12 , DIFF2A, D I FF2B, DS IC2A.DS IG2B 

0302  DOUBLE  PRECISION  OMEGA, SIGMA  1 , DTAN 

0303  DOUBLE  PRECISION  A, SOL  1 , S0L2 , S IG2A, S IG2B, B, RAD2 , RAD, COSMEG 

0304  DOUBLE  PRECISION  COSS 1 , C0SS2A, C0SS2D, S INS  1 , S 1NS2A, S1NS2B 

0303  DOUBLE  PRECISION  XI ,  Y1 , ZI ,  X2,  Y2.Z2,  EM,  YM,  ZM,  SXEW1 , 

0306  1  SICEW2 , BETA , RX l , RY1 , RZ 1 , R I . RX2 , RY2 , RZ2 , R2 , COS MU , XR 1 . 

0307  2  YR1  ,  Zll  1  ,  XR2 ,  YR2 ,  ZR2 ,  ANSWER,  P I ,  RAD  I  AN , 

0308  3  ERROR,  F.WX.EWY.EWZ 

0309  INTEGER  OUTPUT 

0310  COMMON  XI ,  Y1 . Zl  ,X2,  Y2.Z2,  XM,  YH, ZM, SKEW1 , 

0311  1  SKEW2.  BETA,  RX1  .RYl.RZl  .III,  RX2,  RY2,  RZ2,  R2,  COSMU,  XR1 , 

0312  2  YR1 ,  Zm  ,  XR2 ,  YR2 ,  ZR2 ,  ANSWER!  4,6)  ,  P  I ,  RAI)  I  AN , 

0313  3  ERROR, EWX,  EWY,  EWZ,  NUHSOL,  NRE.4D, OUTPUT 

0314  A=  DTAN  ( S I GMA 1 )  *DCOS  ( OMEGA* DT 1 2 ) 

0313  IS0L=0 

0316  SOL 1=0. DO 

0317  S0L2=0. DO 

0318  B=COSIIU/DCOS!  SIGMAl) 

03 1 9  RAD2= A*A-B*B+ 1 . DO 

0320  IFCRAD2.GT.0.D0)  GO  TO  10 

0321  WRITE! OUTPUT, 100) 

0322  100  FORMAT! “  *****ERROR  IN  TIIE  SIGMA  12  SUBROUTINE*****") 

0323  S IC2A=0 . DO 

0324  RETURN 

0325  10  RAD=DSQRT(RAP2> 

0326  C0SMEG=DC03!  0MEGA*DT12) 

0327  S I G2 A=  DATAN ! !  A*B-RAD) /!  B+A*RAD) ) 

0328  S1G2B= DATAN! !  A*B+RAD) /!  B-A*RAD) ) 

0329  IF! SIG2A. LT. 0. DO) S IG2A=SIG2A+P I 

0330  IF! S IG2B. LT. 0 . DO) S IG2B=S IG2B+P I 

0331  COSS 1=BC0S! SIGMAl) 

0332  C0SS2A=DC0S(SIG2A) 

0333  SINS Is OS INI  SIGMAl) 

0334  S I NS2  A=  1)3 1 II!  SI  G2  A) 

0335  C0SS2B=DC03!SIG2B) 

0336  S I NS2B=  DS I N! S I C2B) 

0337  D I FF2A=  DABS!  COSMU-COSS 1*C0SS2A-C0SMEG*S I NS 1*S INS2A) 

0338  D I FF2B= DABS!  COSMU-COSS 1*C0SS2B-C0SMEG*SINS1*S INS2B) 

0339  DS I G2 A=  S I C2 A*RAD I AN 

0340  DS I G2B=  S I G2B*RAD I AN 

0341  IF! DIFF2A. GT. ERROR) GO  TO  20 

0342  C  SIG2A  IS  A  GOOD  ROOT 

0343  IF! DIFF2B.LT. ERROR)  GO  TO  15 

0344  C  SIG2A  G00D.SIG23  BAD 

0345  S0L1=S IG2A 

0346  ISOL= 1 

0347  RETURN 

0348  C  BOTH  ROOTS  ARE  BAD 

0349  12  WRITE! OUTPUT, 110) 

0350  110  FORMAT!  "  **THE  TWO  SOLUTIONS  OF  SIGMA2  ARE  INCORRECT**") 

0331  WRITE!  OUTPUT. 120) DS IG2A, DIFF2A, DS IG23, DIFF2B 

0332  120  FORMAT!  “  THE  FIRST  SOLUTION  OF  SIGMA  2  IS  "D19.13/ 

0353  1  "  WITH  AN  ERROR  OF  "D19.13/ 

0354  2  ■  THE  SECOND  SOLUTION  IS  "D19.13/ 

0355  3  "  WITH  AN  ERROR  OF  "D19.13) 

0356  WRITE! OUTPUT, 999)  S IG2A, SIG2B, COSS 1 . S INS 1 , C0SS2A, S INS2A, COSMU 

0357  I  , COSIIEG, RAD , S I GMA 1 , OMEGA , DTI 2 , A , B , C0SS23 , S I NS2B 

0358  999  FORMAT!"  S  IG2A=  "  1PD23 .  16  "  S  IG2B=  "D23 . 16  ”  COSS  1=  "1)23 .  16/ 

0359  1  ■  SINSI="D23. 16"  CCSS2A= "D23 . 16 "  S INS2A= "D23 . 16/ 

0360  2  "COSIIU= "D23. 16"  COSMZC= "D23 . 16 “  RAD= "D23. 16 ”  S IGMA1= "D23. 16/ 

036  1  3  "  OMF.G A=  " D23 .16"  DT12=  “D2 .  16 "  A="D23.16"  B=  "1)23.  16 

0362  4/"  C0SS2A= "D23. 16 "  S INS2B= "D23 . 16/) 

0363  RETURN 

0364  C  BOTH  ROOTS  ARE  GOOD 
0365  15  1S0L=2 

©366  S0L1=SIG2A 

0367  S0L2=S IG2B 

0368  RETURN 

0369  C  SIG2A  IS  BAD,  SIG2B  IS  GOOD 

0370  20  IF! DIFF2B.GT. ERROR)  GO  TO  12 

0371  SOLI =3 IG2B 

0372  ISOL= 1 

0373  RETURN 

0374  END 
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C  SUBROUTINE  SETUP  DETERMINES  ALL  OF  THE  VARIABLES  IN  TIIE 
C  COMMON  BLOCK 

SUBROUTINE  SETUP 

DOUBLE  PRECISION  XI  .  YI .  7 1  ,  X2 ,  Y2,  Z2 ,  XM,  YM.  Zfl,  SXEW1 , 

1  SKEW2 .  BETA,  11X1 ,  RY1 ,  RZ1 .  R1 ,  RX2 ,  IIY2 ,  RZ2 ,  R2 ,  COSHU,  XII 1 , 

2  YU1 ,  ZR1  ,  XR2 .  YR2 ,  ZR2 ,  ANSWER,  P  I ,  RAD  I  AN , 

3  ERROR,  EVX,  EWY,  EWZ 
IHTECER  OUTPUT 

COMMON  X1,Y1,Z1,X2,Y2, Z2, XM, YM, ZM, SKEW1 , 

1  SKEV2 , BETA , RX 1 , RY 1 , RZ 1 , R1 , RX2 , RY2 , RZ2 , R2 , COSMU , XR 1 , 

2  YR1 . ZR1 , XR2 . YR2 , ZR2 , ANSWER! 4 , 6 ) , P I , RAD I AH , 

3  ERROR, EWX, EWY, EWZ, NUMSOL, NREAD, OUTPUT 
RX1=X1-XM 

RY1=Y1-YM 

RZ1=Z1-ZN 

R 1  =  DSORT(  RX1**2+RY  1  **2+ RZ  1**2) 

RX2=  X2-XM 
RY2=  Y2-YM 
RZ2=Z2-ZM 

R2= DSORT! RX2**2+RY2**2+RZ2**2 ) 

COSMU=  (  RXl*RX2+RYl*RY2+RZl*RZ2)/'( R1*R2) 

C  MAKE  ALL  TIIE  PLANAR  COMPONENTS  NORMAL I SED 
XR1 =RX1/RI 
YR1=RY1/R1 
ZR1=RZ1/R1 
XR2=RX2*R2 
YR2=  RY2ZR2 
ZR2= RZ2/R2 

C  ZERO  OUT  TIIE  ANSWER  ARRAY,  AND  NUKSOL! NUMBER  OF  SOLUTIONS) 
DO  10  1=1,4 
DO  10  J= 1 ,6 
10  ANSWER!  I . J) =0.DQ 
NUKSOL1 0 
RETURN 
END 
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C  SOLVE  IS  THE  MAIN  ORGANIZER  FOR  TIIS  EXPLICIT  SOLUTION 
C  OF  PITCH  AN1)  YAW  ANGLES  GIVEN  DELTA  T  11  AND  DELTA  T  12 
C  THIS  ROUTINE  IS  RESPONSIBLE  FOR  THE  CORRECT  LINKING  OF  ALL 
C  OTHER  SUBROUTINES  WITH  THE  EXCEPTION  OF  INPUT 

SUBROUTINE  SOLVE!  P ITCH, YAW, OMEGA , DTI  1 , DT12) 

DOUBLE  PREC I S I ON  DT 1 1 , DT 1 2 
DOUBLE  PRECISION  OMEGA, SIGHAI 
DOUBLE  PRECISION  SIC2A.SIG2B 
DOUBLE  PRECISION  PITCH, YAW 

DOUBLE  PRECISION  XI ,  Y1 , Z 1 , X2 , Y2 , Z2 , XM, YM,ZM, SKEW1 , 

1  SKEW2 , BETA, RX1 , RY1 , RZ1 ,  R1 , RX2 , RY2 , RZ2 , R2 ,  COSMU, XR1 , 

2  YR1 , ZR1 , XR2 , YR2 , ZR2 , ANSWER, P I , RAD I AN , 

3  ERROR , EWX, EWY , EWZ 
INTEGER  OUTPUT 

COMMON  XI  ,  Yl  ,  Z 1 ,  X2 ,  Y2 ,  Z2 ,  XM,  YM,  ZM,  SICEWl , 

1  SKEW2 . BETA , RX 1 , RY 1 , RZ 1 , R l , RX2 , RY2 , RZ2 , R2 , COSMU , XR 1 , 

2  YR 1 ,  ZR 1  ,  XP.2 ,  YR2 ,  ZR2 ,  ANSWER!  4 , 6 )  ,  P I ,  RAD  I  AN , 

3  ERROR, EWX, EWY, EWZ , NUMSOL , NREAD , OUTPUT 
DIMENSION  ITIMEI5) 

C  CALL  BEGTIM 

CALL  EXEC! 1 1 , ITIME, I YEAR) 

I START3 1000*ITII1E(2>  +  10*ITIME(  1) 

TAT  T  C  IT  Tup 

CALL  SIG1 I!  OMEGA, SIGMA 1 , DTI  1) 

CALL  S IG12!  OMEGA, S IGMA1 , DT12 , SIG2A, S IG2B, IGOOD) 

IF! IGOOD. EQ. 0) RETURN 

CALL  ESUBW! S I GRA 1 , S I G2 A , OMEGA , DT 1 1 , DT 1 2 ) 

I F ! I GOOD . EQ . 2 ) CALL  ESUBW!  S I GRA  1 , S I G2 3 , OMEGA , DT 11 , DT 1 2 ) 

C  I T I HE=  0 

C  CALL  IIARKTIM!  ITIME) 

CALL  EXEC!  1  1 ,  ITIME,  I  ATTAR) 

I  FINIS3  1000=15  ITIME!  2)  + 10*.  ITIME!  1) 

JT I  MS3  I F  I H 1 S-  I  START 

write!  output,  ioodjtime 

1001  FORMAT!  2X,  43 !  "*")/■"  TIIE  TIME  REQUIRED  FOR  THIS  COMPUTATION  WAS” 
1  /1 19"  MILLISECONDS "/2X43( "*")/) 

RETURN 

END 
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C  QUAD  KINDS  THE  QUADRATIC  ROOTS  TO  A  SPECIALIZED  EQUATION 
SUBROUTINE  QUAD( A , B , C , D , ROOT 1 , ROOT2 , ISOL, OUTPUT) 

DOUBLE  PIU'.C  I S I  OH  ROOT  1 ,  R00T2 ,  A ,  B ,  C ,  D ,  AQUAD ,  BQUAD ,  CQUAD ,  RADSQ,  RAD 

INTEGER  OUTPUT 

ROOT 1=0. DO 

RC0T2=0 . DO 

IS0L=0 

AQUAD=  1 .  DO+B*P.+D*D 

C  NOTE  THAT  AQUAD  IS  ALWAYS  GREATER  THAN  ONE 
BQUAD-2. D0*( A*B+C*D) 

CCUAD=  A*A+C*C- 1 . DO 
RADSQ=  BQUAD**2-4 .  DO*AeUADSCQUAD 
1 F  (  RADSQ. GE . 0 . DO )  GO  TO  10 
WRITEC OUTPUT, 100) 

C  THERE  IS  AN  ERROR  APPARENT 

100  FORMAT!  / "  ***ERR0R  IN  QUADRATIC  SOLUTION***"/ 

1  "  CANNOT  TAKE  THE  SQUARE  ROOT  OF"/ 

2  “  A  NEGATIVE  NUMBER"/) 

RETURN 

1 0  RAD= DSQRT!  RADSQ) 

IS0L=2 

I F  < RAD. EQ. 0. DO) IS0L=1 
C  THE  TWO  SOLUTIONS  ARE  IDENTICAL 

ROOT 1  =  - ( BQUAD+RAD) / C  2 . DO*AQUAD> 

R00T2= ( -EQUAD+RAD) /( 2 . BO*AQUAD) 

RETURN 

END 
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C  F.SWX  SOLVES  THE  FOLLOWING  SET  OF  EQUATIONS  FOR  EWX 
C  ER1  DOT  EW  =  C03ISIGMA1) 

C  ER2  DOT  EW  =  C0SCSICMA2) 

C  EW  DOT  EW  =  1 . DO 

C  R00T1  IS  THE  FIRST  SOLUTION  FOR  EWX 
C  R00T2  IS  THE  SECOND  SOLUTION 
C  I SOL  IS  THE  N UlffiER  OF  SOLUTIONS  FOR  THE  SET 

SUBROUTINE  ESWX(  S I GI1A 1 ,  S I GMA2 .  ROOT  1 ,  R00T2 ,  ISOL, DTI  1  ,DT12> 

DOUBLE  PRKC IS  ION  SICMA1 , S IGHA2 , DTI  1 , DT12 

DOUBLE  PRECISION  XI , Y1 ,Z1 , X2 , Y2 . Z2, XM, YM.ZM.SKEWl , 

1  SKEW2 , BETA,  RX1 ,  RY1 , RZ1 ,  111 ,  RX2,  UY2 ,  RZ2 ,  R2,  COSPIU, XRI , 

2  YR1 , ZR1 , XR2 , YR2 , ZR2 , ANSWER, P I , RADIAN , 

3  ERROR , EWX, EWY .  EWZ 
INTEGER  OUTPUT 

COHKON  XI ,  Y1  ,Z1  ,  '12,  Y2  ,Z2 ,  XM,  YM,  ZM,  SKEW1 , 

1  SKEW2 , BETA , RX 1 , RY 1 , RZ 1 , R 1 , RX2 , RY2 , RZ2 , R2 , COSMU , XR 1 , 

2  YR1 ,  ZR1 ,  XR2 ,  YI12 ,  ZR2 ,  ANSWER!  4 , 6 )  ,  P I ,  RAD  I  .AN , 

3  ERROR ,  EWX,  EWY ,  EWZ ,  NUPISOL ,  NREAD .  OUTPUT 

DOUBLE  PRECISION  A , B , G , D , ROOT 1 , RG0T2 , COSS 1 , C0SS2 
DOUBLE  PRECISION  DENOfl,  DENNEW 
C  SET  UP  THE  ERROR  DEFAULTS 
R00T1=0.D3 
RG0T2=  0 . DO 
IS0L=0 

C  GET  THE  DIRECTION  COSINES  FOR  THE  ASPECT  ANGLES 
CCSS1=BC0S(SIGHAI) 

CCSS2=BCCS( S I Gn\2) 

C  NOW  GO  TO  THE  SOLUTION  FOR  THE  NINE  ZILLION  CASES 
IFC (ZR1*ZR2) .NE.O.DOICO  TO  110 
IFIZR1. EQ.O.DO)  GO  TO  10 
IF(ZR2.EQ.0.D3)  GO  TO  5 
WRITE! OUTPUT, 1000) 

1000  FORMAT!"  ***ERROR — SOME  TYPE  OF  LOGIC  MISTAKE***") 

RETURN 

5  IF!  YPJ2 .  EQ.  0 .  DO )  GO  TO  6 
A-C0SS2/YR2 
B=-XR2/YR2 

C= !  COSS 1-A*YR1) /ZR1 
D=-!  XRl+B^-YRl )  XZRI 

CALL  QUAD!  A, B, C, D, R00T1 , R00T2, ISOL, OUTPUT) 

RETURN 

6  IF!  XR2. EQ. 0 . BO)  GO  TO  7 
ISOL= I 

P.OOT  1  =  C0SS2/XR2 
RETURN 

7  WRITE! OUTPUT, 1010) 

1010  FORMAT!  "  ** VECTOR  ER2  IS  THE  ZERO  VECTOR,  NO  SOLUTION**") 

RETURN 
C  ZR1=0. DO 

10  IF! ZR2 . EQ. 0 . DO) GO  TO  11 
C  ZR2.NE.0.D0 

IF!  YR1 .EQ.O.DO)  GO  TO  12 

A=C0SS1XYR1 

B=-XR1/YR1 

C-  !  COSS  1-YR2-KA)  /7.R2 

D=-(B*YR2+XR2) /ZR2 

CALL  QUAD!  A, B, C , D, R00T1 , R00T2 , ISOL, OUTPUT) 

RETURN 

C  ZR1=YR1=0. DO 

12  IF!  XRI. EQ.O.DO)  GOTO  13 
ISOL= 1 

ROOT 1= COSS 1 /XRI 
RETURN 

13  WRITE! OUTPUT. 1020) 

1020  FORMAT!  "  **VECTOR  ER1  IS  THE  ZERO  VECTOR,  NO  SOLUTION**") 
RETURN 
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0541  c  zni  =  o 

0542  11  DEN0M=XR1*YR2-XR2*YR1 

0543  IFIDEN0H.EQ.0.D0)  GO  TO  14 

0544  ISOL= 1 

0545  R00T1=YR2*C0SS1-C0SS2*YR1 

0546  RETURN 

0547  14  WRITE! OUTPUT, 1040) 

0543  C  ZR1.NE.0.D0,  AND  ZR2.HE.0.D0 — 

0549  C  THE  HOST  COMMON  CASE 

0550  110  DEN0M=ZR2*YR1-YR2*ZR1 

0551  IF(  DENOM. EO. 0 . DO)  GO  TO  120 

0552  A=  ( ZR2*C0SS 1-ZR1*C0SS2) /DENOM 

0553  B=!XR2*ZR1-ZR2*XR1) /DENOM 

0554  C=  (  COSS  l-YRl^A)  /ZR1 

0555  D=-(  XRl  +  B'CYIll )  /ZR1 

0556  CALL  GUAD! A, B, C , D, R00T1 , R00T2, ISOL, OUTPUT) 

0557  -  RETURN 

0558  C  DENOM1 0 . DO 

0559  120  DENNEW=ZR2*XR1-XR2*ZR1 

0560  IF( DENNEW. EQ.O. DO)  GO  TO  130 

0561  ISOL= 1 

0562  ROOT  1  =  ( ZR2*C0SS1-ZR1*C0SS2)  /DENNEW 

0563  RETURN 

0564  130  WRITE!  OUTPUT. 1040) 

0565  1040  FORMAT!  “  **ER1  AND  ER2  ARE  NOT  LINEARLY  INDEPENDENT, 

0566  1  “NO  SOLUTION") 

0567  RETURN 

0568  END 


0569 
0570 
0371 
0572 
0373 
0574 
0575 
0576 
0377 
0573 
0579 
0580 
0581 
0582 
0583 
0504 
0503 
0586 
0507 
0588 
0589 
0590 
059  1 
0392 
0593 
0594 
0595 
0596 
0597 
0598 
0599 
0600 
0601 
0602 
0003 
0604 
0605 
0606 
0607 
0608 
0609 
0610 
0611 
0612 
0613 
0614 
0615 
0616 
0617 
0610 
0619 
0620 
0621 
0622 
0623 
0624 
0623 


C  THIS  ROUTINE  CALCULATES  THE  TINE  REQUIRED  FOR  DELT1 I 
C  AND  DELT12  TO  ROLL  THROUGH  THE  RESPECTIVE  GROUND  STATIONS 
SUBROUTINE  TINE( DELT1 1 , DELT12 .ONEGA, DTI 1.DT12) 

DOUBLE  PRECISION  XI , Y1 ,Z1 , X2, Y2, Z2, XM, YM, ZM.SKEWl , 

1  SKEW2 . BETA, RX1 , RY1 , RZ1 ,  III , RH2 . RY2 , RZ2 , R2 , COSHU, XR1 , 

2  YR1 , ZR1 , XR2 , YR2 , ZR2 , ANSWER, P I , RADIAN , 

3  ERROR, EWX,  EWY,  EWZ 
INTEGER  OUTPUT 

COMMON  XI , Y1 ,Z1 ,X2, Y2,Z2,XM,  YN, ZM, SKEW1 , 

1  S  KEW2 , BETA , RX 1 , RY 1 , RZ 1 , R 1 , RX2 , RY2 , RZ2 , R2 , COSNU , XR 1 , 

2  YR1 , ZR1 , XR2, YR2, ZR2, ANSWER.! 4,6)  , PI, RADIAN, 

3  ERROR,  EWX,  EWY,  EWZ, NUNSOL ,  NIIEAD .  OUTPUT 
DOUBLE  PRECISION  DTI  1 , DT12 , DTAN 
DOUBLE  PRECISION  ONEGA, DAS  IN 

DOUBLE  PRECISION  XYI1AG, P ITCH. YAW, P ITOUT, YAWOUT, S INPIT 
DOUBLE  PRECISION  SINYAW’.COSYAW, COSPIT, H 1 , WT1 ,E1 , N2, E2 .DELT1 1 
DOUBLE  PRECISION  DELT12 , ERRU , ERR 12 
C  DOUBLE  PRECISION  DEG11.DEG12 

XYMAG=  DSGRT!  EVX**2+EWY**2 ) 

P I TCH=  DATN2  (  EWZ , XYMAG) 

YAW= DATN2(  EWX, EWY) 

P I  TOUT=  P  I  TCH'SRAD  I  AN 
YAWOUT=  YAWSRAD  I  AN 
SINYAV=D3IN(  YAW) 

SINPIT=DS IN! PITCH) 

COS YAW=  DC03  C  YAW) 

COSP IT=  DCOSC  P I TCH) 

N 1  =  C03YAW*RX1 -S 1 NYAW*RY I 

W 1  =  S I NYAW*COSP I T*RX1 +CQSYAW*COSP IT*RY1+S I NP IT*RZ 1 
E 1 = -S I NYAW*S I NP I T*RX 1 -COS YAW*S I NP IT«RY1 +COSP IT*RZ 1 
N2=COSYAW*RX2-S  I IIYAWSRY2 

E2=-SINYAW*S  INPIT-:<RX2-C0SYAWT:KS  INP  IT*RY2+C0SP IT*RZ2 
DELT1 1=  (  BETA+DAS IN!  W is DTAN ( SKEVl ) /DSQRT! E1*E1+N1*N1) ) ) /'ONEGA 
DELT12=  (  DATN2 ( E 1 ,  N 1 )  -DATN2(  E2 ,  N2)  )/OIlEGA 
C  DEG1 1  = ONEGA* DELT 1 1*RADIAN 

C  DEG 12= ONEGA* DELT 1 2*  RAD I AN 

ERR1 1=DABS( DELT1 1-DT1 1) 

ERR12=DAB3!  DELT12-DT12) 

NUKS0L=NUKS0L+1 
ANSWER!  N UNSOL . 1 )  =  P I TOUT 
ANSWER! NUN30L, 2) = YAWOUT 
ANSWER! NUNSOL, 3) =DELT1 1 
ANSWER! NUNSOL , 4 ) =  DELT 1 2 
ANSWER!  NUNSOL, 5) =ERR1 1 
ANSWER! NUNSOL , 6 ) =  ERR1 2 

IF!  DABS! P ITOUT) . GT. 90. DO . OR. DABS! YAWOUT) . GT. 90. DO) RETURN 
IF! DABS!  DELT12-DT12) . GT. ERROR)  RETURN 
WRITE! OUTPUT, 02) P ITOUT, YAWOUT 
WRITE! OUTPUT, 999) DELT1 1 .DELT 12 
999  FORMAT!  “  DELT1 1= " 1PD23. 16 "  DELT 12= "D23. 16) 

82  FORHAT!"  USING  PITCII=  "2X.F1 1 .6  “  DEG  AND  YAW=  “2X,  F 1 1 .6"  DEG") 
C  WRITE!  OUTPUT, 40DDEG1  1  .DEG12 

C401  FORMAT! / "  DELTA  T  11  ROLLS  THROUGH "F20 . 15 “  DEGREES "Z 

C  1  n  DELTA  T  12  ROLLS  THROUGH* F20 .  15 "  DEGREES’1) 

CALL  ERR!  DT 1 1 , DT 1 2 , ONEGA) 

RETURN 

END 
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C  THIS  IS  A  ROUTINE  TO  AUGMENT  THE  MINI-COMPUTER 
DOUBLE  PRECISION  FUNCTION  DASIN(X) 

DOUBLE  PRECISION  X 

DAS  I N= DATN2I  X. DSQ11TI 1 . DO-X*X) ) 

RETURN 

END 

C  ANOTHER  SUBROUTINE  FOR  THE  EDIFICATION  OF  A  MIN  I -COMPUTER 
DOUBLE  PRECISION  FUNCTION  DTAN(  X) 

DOUBLE  PRECISION  X 
DTAN=  I)S  INI  X)  /DCOSI  X) 

RETURN 

END 
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C  ERROR  CALCULATES  TIIE  ERRORS  OF  S IGMA1 , S IGMA2, P ITCH,  AND  YAW. 

C  THIS  ANALYSIS  IS  BASED  ON  TOTAL  DIFFERENTIALS  WITH 

C  QUADRAT 1 C  PERTURBATIONS  NEGLECTED,  AND  WITH  SHALL  ANGLE  APPROXIMATIONS 
C  SO  THAT  S I II (  DELTA  P)  =  DELTA  P.  AN!)  COS(  DELTA  I>)  =  I 
SUBROUT I NK  ERIK  DT 1 1 , DT 1 2 , OMEGA) 

DOUBLE  PRECISION  XI , Y1 , Z1 , X2, Y2, Z2 , XM, YM, ZM. SXEWl , 

1  SKEWS, BETA, RX1 , RY1 , RZ1 , R1 . RX2 , RY2, RZ2 , R2 , COSHU, XR1 , 

2  YR 1 ,  ZR 1  ,  XR2 ,  YR2 ,  ZR2 ,  ANSWER,  P 1 ,  1XAD I  AN , 

3  ERROR, EWX, EWY.EWZ 
INTEGER  OUTPUT 

COMMON  XI ,  Y1 ,  Z 1 ,  X2 ,  Y2 ,  Z2 ,  XM,  YII,  ZII,  SKEW1 . 

1  SKEW2 , BETA . RX 1 , RY 1 , RZ 1 , RI , RX2 , RY2 , RZ2 , R2 , COSMU, XRl , 

2  YR  1 ,  ZRI ,  >312 ,  YR2 ,  ZR2 ,  ANSWER!  4 , 6 )  ,  P  1 ,  RAD  I  .AN , 

3  ERROR,  EWX,  EWY,  EWZ.  NUMSOL,  NIIEAD,  OUTPUT 

DOUBLE  PRECISION  A, ALPHA, ARC, ATANG1 , ATANC2 , ATERM, A 1 , A2 , BTERM, 

1  B 1 , B2 , COSALF , COSC 1 , COSP IT, COSS 1 , C0SS2 , COSW, COSYAW, CP  I , CP2 , CTERM, 

2  CT1  ,CT2, C 1 , C2, DALF , DENOM, DG1 , DG2 , DIIU, DP  ITCH, DP  1 , DP2, DSIG1 , DSIG2, 

3  DTAN.DT1  ,DT1  I  ,  DT12  .  DT2 ,  DWDT12,  DYAW,  0I1EGA,  PHI  I  ,  I’ll  12  ,  P  ITCH,  RAD, 

4  S I GMA 1 , S 1 N ALF . S I NMU, S I NP I T, S I NS 1 , S I NS2 , S I NW, S I N YAW, SP 1 , SP2 , ST 1 , 

5  ST2 ,  TANC  1 ,  TERIil ,  TERH2 ,  TEIU'3 ,  THETA  1 ,  TIIETA2 ,  XNUMER,  XYMAG,  XYILAG 1 , 

6  XYT1AG2 ,  YAW 

DOUBLE  PRECISION  BOUND, DELI’ .  DELY 
DOUBLE  PRECISION  S 1 OUT , S20UT , D3 1 OUT , DS20UT 
DO  1030  1=1,5 
BOUHD= 1 ,D0**(-I+1) 

9  FORMAT! "  NOW  INSIDE  TOE  ERROR  ANALYSIS  ROUTINE,  WITH  ALL"/ 

1  "  PERTORBATIONS  SET  AS  “  F 1 0 . 5 ) 

WRITE! OUTPUT , 9 ) BOUND 

DP  1  =  BOUND 

DP2= BOUND 

DP2= BOUND 

DWDT 12= BOUND 

DALF = BOUND 

DC 1= BOUND 

DG2= BOUND 

DTI = BOUND 

DT2= BOUND 

THETA 1  =  DATN2! XR1 , YR1 ) 

T1IETA2  =  D  ATM  2 !  XR2 ,  YR2 ) 

XYILAG  1  =  DSQRT!  >3! I W*2+YRI**2) 

>WIAG2=DSQRr!  XR2**2+YB2**2) 

PH  I  1  =  DATN2!  ZRI  ,  XYMAG  1 ) 

P II 1 2  =  DATN2 !  ZR2 .  XYMAG2 ) 

CP1  =  DC0S! PHI  1) 

CP2=DC0S( PH 12) 

SP 1  =  DS IN!  PHI  1) 

SP2=DS I N! PH  12) 

ST  1  =  PS  I N !  THETA  1 ) 

ST2=I5S  IN!  TN2TA2) 

CT1  =  DC03!  THETA 1) 

CT2=  DGOS! THETA2) 

YAW=DATN2!  EWX,  EWY) 

XYHAG=  DSQRT!  EWX s*2+EWY**2) 

P I TCII=  DATN2!  EWZ ,  XYMAG) 

COSP IT=  DGOS! PITCH) 

SINPIT=DS IN!  PITCH) 

C0SYAW=DC03!  YAW) 

SINYAW=DSIN!  YAW) 

C  CALCULATE  HU  AND  DMU 

COSMU=  >31 1 «XR2+ YR 1 * YH2+ZR 1 *ZR2 
SINIIU=  DSQRT!  1 .  DO-COSMU**2) 

XNUTIER=  SP  laST  I  a!  SP2HST2»DP2-CP2*CT2*DT2)  + 

1  CP2aST2*C  SP laSTiaDP 1-CP t-CTl*DTl )  + 

2  CPiaCTia!  PP2*CT2*DP2+CP2*ST2*DT2>+ 

3  CP2*CT2*( SPU-CTiwD? 1+CP1*ST1*DT1) - 

4  CP  1*3P2*DP  1-SP I  ::CP2*t)P!> 

DMU=  XNUNER/S I NHU 
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C  CALCULATE  DSIG1  TOE  ERROR  OF  SICMA1 
ATAHG 1  =  DATAN (  SKEW 1 ) 

ATANC23 DATAN! SKEW2) 

ALPHA3  OMEGA*  DT 1  1  -  BETA 
C0SC1  =  DC03(  SICEW1) 

A=ATANC2/ATANGl 
COS ALE- DCCS( ALPHA) 

S I NALF= DS  I  N( ALPHA) 

TANG  1  =  DT.AI1  ( SKEW  1 ) 

RAD3  D3C5RTC  1 .  B0+A*A+2 .  D0*A*C0SALF) 

TEHII1  =  TANG  1  * (  COSALF*RAD/S  I NALF**2- A/RAD)  *DALF 

TEIUI23  (  RAD/C  S I NALF*C0SG  1  *C0SG  1 )  -TANGl/!  S  IT1.ALF*RAD)*C  A+COSALF)  * 
1  ATANC2/ATANG1#*2«!  1 . DO/C  1 . D0+SICEW1**2> ) )*DG1 

TERM33 TANG 1 /S I NALF*  ( A+COSALF) /RAD/ ATANGl/C 1 . D0+SKEW2**2) *DC2 
ARC3  TANG  1  /S I  HALF*  RAD 

DS IG1 3 1 .  D0/(  1 .  D0+ARG**2)  *C  TERM 1 + TERM2 +TERM3  ) 

S I GMA 1  =  DATAN  ( ARC) 

S 1 OUT3  S I  GILA  1  SHAD  I  AN 
DS 1 0UT= DS I G 1 *RAD I AN 


C 

c 


WRITEC OUTPUT, 10) S 1GHA1 , DS IG1 , S lOUT. DS lOUT 
10  FORMAT!  "  SIGMA13  "  1PD23.  15  "  RADIANS,  WITH  DSIG13  "D23.  15/ 

1  •  = "0PF23 . 15 "  DEGREES  = "F23. 15 “DEGREES") 

CALCULATE  DSIG2  FROM  IMPLICIT  TOTAL  D I FFERENT I AL  OF  THE 
TWO  STATION  ASPECT  ANGLE  FORMULA 
C0S3 1  =  DCOSC SIGMA1 ) 

SINS  1  =  DS  INC  S IGHA1 ) 

C0SS2=  XH*XR1+  YM--.-YR 1 +ZM*ZR  1 
SINS2=BSQRT(  1 . B0-CCSS2**2) 

CCSW3 DCOSC 0UEGA*DT12) 

S I N W=  DS I NC  OMEG A* DT 1 2 ) 

DENOII3  S I  NS  1  :“C0SS2*C0SW-C0SS  1  #S  I  NS 2 
ATiiRH3  C  S I N3 1  *CC3S2-C0SS  1 *S 1  NS2*C0S W)  *DS  I G 1 
BTERM3  C  S I H3  1*31 NS2*S I NW) *DWDT 1 2 
CTERH3  COS?IU*DNU 

DS IC2= C  ATERM+ BTERH-CTERM) /DENOM 
S I  GIIA2=  DAS  I  TIC  S IN32  ) 

S20UT=  3 1 CMA2*RAD I  AN 


DSC  OUT3  DS2  .'RAO  I  AN 

WRITE!  OUTPUT, 20) SICMA2 , DS IG2 , S20UT, DS20UT 
20  FORMAT!  "  S IGMA23 " 1PD23 . 15 "  RADIANS,  WITH  £3IG2= °D23. 15/ 

1  "  3  "0PF23 .  15  "  DEGREES  3,,F23.15"  DEGREES*) 

A 1 3  -S I  IIP  1  T*S  I  NYAVSCP  1  «ST  1-SINP1 T*COSYAW*CT  1 +COSP I T*3P 1 
B 1  =  COSP I  T*CCS  YAW:::CP  1  *ST  1-COSPI  T*S  I N YAW* CP  1  *CT  1 
C 1  =  -S INS 1 * DS I G 1 +GCSP I T*S I NYAV*C SP 1 *ST I *DP 1 -CP  1 *CT1 *DT 1 ) 

1  +COSP IT*COSYAW*C  SP 1*CT1*DP1+CP 1*ST1*DT1 ) -5INPIT*CP1*DP 1 
A2=-S  I  UP  ITS 3 1  HYAY."*CP2»ST2-S  I  IIP  IT*CO3YAV*CT2+C0SP  IT*SP2 
B2=C0SP IT*CGSYAW*CP2*ST2-C0SP I T*S I  IJ  YAW*CP2*GT2 
C23 -S  !IIS2t:-”  5  WT-'.-CCSP  IT*3INYAW*C  G?2*ST2*D?2-C?2*CT2*!:T2' 

1  +CC3PlT*C0  ■■  YA •  I.': C  S?2*CT2*D?2+CP2*3T2*DT2 )  -SIK?IT*C?2*DP2 
DEHOII3  A 1  *B2- A2*B  1 
DP  ITCH3  C  C 1  *B2-C2*B  1 )  /DEIIOM 
DYAW=  C  A 1  *C2-A2*C  1 )  /DENOM 


DELP3  DP  ITCISSRAD I  -AN 
DELY3  DYAV*RAD  I  AN 

WRITE!  OUTPUT,  30)  DP  ITCH,  I)YAW,  DELP ,  DELY 
30  FORMAT!  “  TOE  ERROR  OF  PITCH  IS"1PD23.13"  YAW  IS"D23.15"  RADIANS"/ 
1  11  IN  DEGREES,  THIS  IS  *0PF23. 13*  "F23.15) 

1000  CONTINUE 


RETURN 


END 


END  3 


40 


APPENDIX  II 


LTPOS 

Program  to  Determine  Vehicle  Position 
(Interdata  OS/32  Version) 


$HA  rCH 

C  PWUG  RAM  LrP0S(J,8S) 

c 

c  PROGRAM  TO  W  f :  M »  L  A  5  E.  H  ThACKER  DATA  TaPF,  ihp*c<  data, 

c  smooth  am)  output  u  li^e  printer  i  i  tammlam 

c 

c 

COMMON  I  H  (  3  7  )  ,  1  ‘-(  .3  2  )  ,  SKCC  3?)  ,  AZC  3?  )  ,EL(  3  7.)  .  RA(  U  )  , 

X  L.1  Ml  3  2  )  ,  liolv  (  3  7  )  ,  |  SOT  32)  ,  I.SHO'i  C  3  2  )  ,  I  CMP  (  3  i  )  ,  1  AUTO  (  3  2  )  , 

X  XU ,  I  I. ,  2b ,  !  -1 1  ,  J  1  ,  Sc  c  1 

C  X  PULST1  (  32o)  ,PULS  1  21  320)  ,  t-  POCH(  320  )  ,  P  JUS  « (  320  ) ,  PULSPI  320  ) 

C 

C 

C  UCniKLK  PWfcClSlO'f  IH,  I*,SEC, IH1 ,IM1  ,SEC1 

C  X  EPOCH, PULS*,  PULSP 


c 

INTEGER  POLSM  ,  PULS  12 

1  N  I  E  G  K  R  ♦  4  H  R  ,  v  «  ,  J  ,  M  iJ  ,  •*  S 

i m tege  r»a  ih,im,ihi,im 

DIMENSION  IP(5),IJ(2) 

DIMKAS  ION  IST(h) 

DIMENSION  *»( 44H  ),  1SKC( 32 ), 1MS( 32) 

E  DU  I  V  ALENCE  (  IP(  1  )  ,  LOT  ,  l  IP(  2  )  ,  L.P)  ,  (  IP(  3  ) 

,NF1LE]) 

c 

F'.yiJi  VALE..CE  (  1  ,  1  J  (  1  )  )  ,  C  J  ,  1  J  (  7.  )  )  .  (  IPC  A)  ,  JpE  Z) 

c 

DATA  RA0FG/5 7. 295 77951/, PI/3. 141592054/, 

IPAGE/l/,  IP 4T/0/ 

c 

OAT A  Pl?/b, 2831853 08/, AZO/90./, KLu/O./ 

c 

c 

GET  USc-K'S  CONSOLE  S,  LPK  LU'S 

b 

CALL  CLOSEt 8 , 1ST] ) 

CALL  CLOSE (1,1312) 

C&LL  CbOS£(R,  IS)  i) 

CALL,  OPR  <  -  (  l  ,  •  CUim  :  '  ,  4 ,0,0  ,  1ST4) 

CALL,  OPE.*  *  16,  '  PK  ;  '  ,  2, 0, 0,  IvSIS  ) 

CALI,  OPITW*  (  8  ,  "'.AGO  •  '  ,  0 , 0 , 0,  IS  IN) 

125 

1  7  b 

1  F (  IST1  .  •  E  .  0  )  GO  TO  409 

con  r  i  -*ut 

lniSf?.^.,'))  GO  Til  401 

C  .1  -  I  1  \')K 

127 

lKdSl'j.  JF.,0)  GO  J'u  402 

CONTI  Ml  F 

J  28 

IE( IST4.NE.0  )  GO  TU  403 

COM T I  N'.l E 

129 

IE (ISI5.NE.0)  GO  ru  404 

CON  TIN  IJ  F 

1  30 

I  F  (  131  9  .  >K  .  0  )  GO  l’U  495 

CON  flNUt 

LU  =  0 

LPsO 

NET  LE  =0 

NHEC  =  <> 

I  E(  LIT  .  EO  .  9  )  l, U  -  \ 

IF(LP.E.O.O)  LP  =  9 

C 

C 

IE(t.E  ILK.r.U.u)  GOTO  2 

IECNRE.C.E. N.O  )  NPE„C  =  1 

/\ 

postsjiun  tape  ro  ejll  s  re.c  #  (defaults 

=  1  ) 

C 

call  V*  rpFL(  1  FILE,  ,-HE.r  ) 

42 


nnonnonnoni  ;  ;  non 


C  Kfr'Af)  FIRST  r  ai  J  wfjwDS  F  Uk  1-0 

C 

2  CONTINMIK 

C  CALL  F *FC(  1  ,  UOb,  I  J,  2  ) 

kt,AD(W)*< 

12  0  F  IR  ’*  A 1  f  2  A  2  ) 

SfcL  A  l<  A  I  F.  1  'TO  H  ,  *  ,  S 
0  M  F  A  C  K  (.)  A  T  A 
Ksl 
L  =  K-  1 
HK  =  0 

I  A  P  r;  i  s  l  »  ♦  L  i  _ _ _ 

J  =  -  M  l  1  A  KG  1  ) 

hp=hr  f  c  [SMf  r  (.],-<  i  ) )  *20 

HK=H0+(  I  SHF  I  ( (  1  SHF  1  ( J ,  1  )  )  ,  - J  1  )  )  ♦  1  0 
H«sHW*(ISHFT((1SHF’11J,2)),-28)> 

1 H 1  =  HR 

MNsO 

ISHFT(  1SHFT(  J,6 }  ,-il ) )*40 
m  n  =  M  n  ♦  (  I S  H  F  1  (  I  S  <  F  i  (  j  ,  / )  ,  -  j  l  ))*/() 
w  N  =  M  N  +  (  I  S  H  F  1  (  1  S h e  1(J,8),-J1))*10 
=  k  fJ  F  (  I  SHF  r  (  I  SHF  I  (  J  ,  9  )  ,  -  3  1  )  )  *  R 
MN  =  KNF (  l SHF  1  (  l SHF r ( J , 10  )  . -3  n  )  ♦ A 
MW8MW»( ISHFT( ISHF1 ( J , 1 1 ) , - 31  )  ) *2 
MN*MN+( I  SHF  I ( 1 SHFI (  J ,  1 2  )  , -31  ) ) *  1 

1  M  1  =V,,\ 

KSKC&0 

KSFC  =  *  SFC+ USHF  l  (  ISHFK  J  ,  1  3  )  ,-il)  )  **0 
KSfcC  =  *SKC*( J  SHFl( 1 SmFT ( J , 1 4 ) , - 31 ) ) *20 
KSF.CsKSK.C*  (  I  ShF  I  t  I  SHI-  I  (  J  ,  1  S  )  ,  -  31  )  )  «  1  0_ 

KSFC  =  KSFC* ( I  SHF  1 ( 1  SHF  I  ( J , 1 t> ) , -3 1 ) ) *8 
KSFC  =  KSFC+(  I  SHF r( lShFT(J,  17)  ,-31))  *4 
KSKCsKSFC*USHFT  (  iSriF  1'  (.) ,  1  8  )  ,  -  31  )  )  *7. 

KSFC  =  I*  SFCM  l  SHF  l  (  J  SHF  t  (  J  ,  1  9  )  ,  -  3  1  )  )  *  1 
40  1SKC(K)=KSFC 
MS«0 

*S  =  »S+(iSHF  I  ( I  SHF  r ( J , 20  )  , -31  )  )  4800 
HS=«S+(  1  SHF 'I  (  1SHFTC  J  ,  ?  1  )  ,  -  31  )  )  *400 
"S  =  MS+ (  IShF  T<  J  SHF  T( J, 22 ) ,-31  )  )  *2oo 
V  s  =  VS  ♦  (  I  S'tr  I  (  I  S n  5  i  (  i  ,  /  3  )  ,  -  1  1  )  )  *  1  <  I 
"ha*  St(  I  SuF  f(  IS. I-  I  ( J ,/*),“ 3  I  ))♦«<! 

l'S  =  "  S4  (  IShFTC  lSBFf(  J,2b)  ,-31  ))♦  4 0 _ 

MS*HS+ (l SHF  T  C ISHF f CJ #  2  b ) » ■31) ) *20 
MS  =  MS*( 1SHF l ( 1SHF  r( J , 2  /  )  , -3 1  )  1*10 
MS  =  MS+(  I  SHF  r ( I  SHF r(J,28),-31))*b 
MS  =  h.S  +  (  I  SHF  1  (  J  SHF  f  (  J  ,  2H  )  ,  -  3  1  )  )  ♦  4 
‘\S  =  "S  +  l  I  SHF  l  (  1  SHF  I  (  J  ,  30  )  ,-31  )  )*2 
HS=MSF(  l  SHF  r (  I  SHF  I  ( j  ,3 1  ),— 31  )  )  *  1 
1MS(K)sms 

SFC  1  s  F  l.  0  A  r  (  ISFCCK  )  )  FFLUrt  T(I"S(K))/1  000. 

1 H  1  =  I  ShF  1  (  1  A  nii  (  i  ,  1  4  0  o 00 H  )  ,  -  1  4  )  *  1  0  + 

*  IShF  l  (  1 6 HIM  ( , JooOUH ) , - 1 0) 

1*1  =  ISHFT  (  l  A  .Df  1  ,  1  n(IOh)  , -7  1  *  1  O  + 

X  ISHF  f (  T  An 0(1,  170b) ,— 3) 

3FCI  =  F'l/OAl  (  I  A0IH1,7H)  )♦  10.  * 

X  FI, DA  r  (  ISHF  I  (  l  A  *  I)  (  J  ,  1  7  O00OH  )  ,  -  1  2  )  )  ♦ 

X  FLDA r ( I  SHF r (  I  a  <o( J , 7400B) , -H ) ) /I 0.  f 

X  Fl.'JArU  SHF  1  (  l  A  -.IM  J  ,  3b OH)  ,-4)  )/  J  0(i,  ♦ 

X  Fi.JA  T(U.'DIJ,1  7  H  )  )  /  1  000. 

i  rm  h  ,  44K  )  i  h  j ,  i  / 1 ,  st-  c i 

C  4  o  h  •-  r  n-  •  *  r  (  >  > ,  i  / .  - ,  /  i  ,  i  ;  ,  is,  i) 

C  -  > .  i  -  -o  i  i  ,  i  i  ,  I  ■  I  ,  s  f  r  t  i 

c  ►< ,,  r  ►  . '  >  i,|  M'Shl  H-  » r  C  ■  **  > 

A3 


on  o  o  o  non  onnnooo  non 


C  CALI.  KXtCn^lOH) 

P  E  w  I  n  D  # 

*  R  IT  E  (  L  l' ,  1  0  0 ) 

100  Fl)RMAT(  'FUTFP  AZIMUfM.ELLVATIUN  u*  FSET  (Dt-J)') 

RE  AO  (  Ll'  «  *  J  AZO  ,  KLO 
AZO  =  AZO/K  AL)£G 
ELO  =  ELO/RADEG 
get  laumchfr  coords. 

« w  l  rt-  c  i,u ,  i  i  <•  * 

no  kokma  ii«  tew  ren  i.  a  in  c  n  e  p  cjokojoaihs  (x*y*z)') 

PEAI)(LU#*)XL,  V  L  *  Z  b 
REAP  DATA  REC  JRU 
1  CALL  UMPCK(IEOF) 

OFFSET  CORRECT  IO>IS 

oo  iu  r*T7T2 

AZIMUTH 

A Z  C  1  J  =  ( AZC l )*ibO./262144.)/RADEG  +AZ0 
I F  (  A  Z  (  I  )  .  G  f  ,  ?  I  )  AZ(1)=AZ(I)-fI2 
1F( AZ( I ) .LI* »PI  )  AZe I)sAZ(I)*PI2 
F.Lfe  V  A  I  I  O.v 

t  L  (  1  )  -  ls.L(  I  )♦  )/PAPFG  f  KLO 

IF(FLdJ.GT.Pl)  EL(I)=EL(1)-PI2 
IF(ELCI ).Lr,-PI  )  e L  C I )sEL(i )  +  Pl2 
TILT 

AZ(U  =  ATA:.2  (  SI  m  (  AZ(  I  )  )  *  COS ( FL (  I  )  )  ,  COS(AZfD)*  C0'S'(  EL  (  1  )  )  ) 
AZCIJ  =  AZC l )*RAD€G 
Ft,  ( r )  =  el u  )*7j aoeG 
#kn£l6,600)AZ(I),EL(l),RA(I) 

600  FORM  AT  l 10X , 3 ( 3X ,F1 3. 7  )  ) 
id  c J “•  TIN u 

CALL  nu  I  F  I  (  LP,  1  EOF , IPO  1  ,  I  PAGE) 

IF(I£flF.  JF.  1  )  G01J  1 
99V  RE n 1  NO  R 

*RITE(LP*200) 

20(1  F  (1 R  V  A  f  {  »l  ’  ) 

GO  Tn  n 
40(1  *-Wllfll*451*)  till 

30  TO  1 ?  b 

450  FOR  A  T  (  'DEVICE  aSS 1  Go "Kn T  E  PROP  *  ♦  ♦  1ST  1  =  '  ,  I  5  ) 

4  01  rt  K  I T  £  ( 1 ,  452  )  J  S I  2 

GO  TO  126 

402  *PITE(1,453)  I S  T  3 

GO  10  127 

4  0  3  *R I TE ( 1 , 45  4 )  1  S  l  4 

60  TO  12R 

404  aRlTFt 1*455)  1S(5 
GO  TO  129 


4  05  A P  X  T K  C  1 ,456)  I  Si  6 
GO  TO  130 


452 

F OP "  A  1  ( 

til-  V  1  c F 

ASSl G  *  * E N r 

F  P  P  u  h  *  *  *  T  S  T  7  -  ' 

,15) 

453 

HIR’AM 

LEV  ICE 

A  S  S  I  G  i  M  r,  v  1 

EFhUP*  *  *  TST  3=  ' 

*15) 

454 

f  ok^A r  < 

Of-  VICE 

A  S  S  1  G  x  '*  E  0  I 

t-  KK(IP*»  *  IS  l  4=  ' 

»  IS) 

455 

FUR  '.*11 

DEV  l C  f 

ASSIGn^KN l 

E  P  H  0  P  *  *  *  1  S I  5  =  ' 

,15) 

456 

FOR*-’  A  1  ( 

OF  VICE 

A  S  S I  G  (V  J  K  N  T 

ERHIJH*  *  ♦  I  ST6=  ' 

,  f  5) 

99 

CON  I  1  l>  ‘ft. 
KuO 

<;,(  »K'iii  i  i 

►  '  r  ..  * 

*  |  |  i  m 

(  t-  M  ,  ,  RFC 

1 

1 

•  ^  1 1 1 .  • 

1  f  r  C  = 

i"  r  L 

1 

1 

44 


oonnnonon  nnnonoo 


A  *»  o 


C  Fid)  FILE 

1  CONTINUE 

ifcifile.lf.o)  goto  in 

C  EXEC  CAIiL  WEmQvKO  NERK 

IF  CUE  =  l  Flit  -  1 _ _ 

GOTO  1 

C  KIND  RECORD  » 

10  CON  I  I  'I IJE 

IF( TREC.LE.O)  GOTO  99 
C  EXEC  CM, E  riMH'UE)  HEkE 
I RFC  =  I  SEC  -  1 
GOTO  10 
99  RETURN 
E  N  0 

SUBROU  r  I  NE  HEAD*  (Lu  ,  LP,  1H  ,  1  r  .  SEC) 

ROUTINE  TO  PRINT  HEADER  SHEET  FOR  LASER  TRACKER 
DATA  LIST 

DIMENSION  I  PRO J ( ID) , IDA  I  El S) 

DOUSLE  PRECISION  1H,IM,SEC 
INTEGER  *4  IH  ,  1H  1  , 1 '•’ »  1  M  1  _ 


WRITECLU, 100) 

10U  FOR*AT( • ENTER  PROJECT  NAME') 

READCLU,  101  )  (IP-1  JJ(k  )  ,  k  =  1  ,  ID) 

101  FORMA rc 10 A2) 

WRITECLU ,110) 

110  FORMAT (  ' E  J  T  E  R  TEST  DATE  (EX:  01  JAN  7H)  ') 

READCLU , 1 1  1  ) ( I  DA TE IK)  ,Kj*l  ,5) 

►RITECLU,  Du) 

120  FORM  AT  (  '  f  I  ME  LIE  TEST  '  ) 

READCLU  1 121 ) IH, 1 M,SEC 
121  FORMAT  (2(I2,X),FS,3) 

111  FORMAT (5A2) 

NR  I TE ( LP ,  200 ) 

200  FORMAT ( 1  HI , 2D( /  )  , 

X  4  0  X  ,  'US  ARMY  MISSLE  RESEARCH  AND  l)F  V  FLOP  ME'4  f  COMMAND',/. 

X  5  IX  ,  '  f  *C- '"JL  ,‘t;  Y  L  M-  U  !■  A  1 1 1 H  Y  1  ,  /  , 

X  «♦  M  X  ,  •  S  Y  I  *  •  S  |  *•  •_:  i, « 1  1  '  !  ’  1  R  E  0  V  O  E  A  I' E  *  ,  /  , 

X  b  3  X  ,  •  S  j  S  i  r.  •'  S  EVALUATION',//, 

X  50X  ,  '  LA  MPA.'tS  -  LASER  TRACKER',//) 

WRlTECuP,  21  0)  (  IPRi'JIK  )  ,  E  =  1  ,  lu)  ,  (  IDAfE(K)  ,  Ksl  ,  S  )  ,  H.  I  M  ,  SEC 
210  FORMAT (lSX,10A2,2JX,SA2,26X,2(12,':'),Fb.3) 

RETURN 

END  _ 

SO  HR  DOT  l  nK  UNPCk  l  1  EUE  ) 

ROUTINE  TO  R  t  A  0  LA-tPAM'S  DATA  TAPE  AND  IJMPaCK  DATA 
INTO  VARIABLES  l H  0  U  K  S , m 1  <  U 1  K  S  ,  S  K  C  ,  A  Z  »  E  L  ,  R  A  ,  ETC.) 


returns: 

I  EOF  s  0  IF  uTRr  DAi'A  On  TaPE 
I  EOF  =1  IF  END  OF  FILE  DETECTED  NT  T  M  READ 


L 


COMMON  1H(  32)  ,  1  M(  32)  ,  SEC  1  32)  ,  AZ(32)  ,F.LC  3  2  )  ,  3  A  (  32)  , 

r  t  •  •  t  2  )  \  i  . j  1 1 ,  f  2  'i  v  i  c  r  >  t  2  '2  \  i  clmv.1  /  n  i  r  «  «  11  r  i  2  \ 


LI  •  (  32  )  ,  I  ROV  (  32  )  ,  ISP(  32  )  ,  LSR'lN  (  Y2  )  ,  t  CMP(  32)  .  1  AUTUf  32)  , 
XL,  i  I, ,  2.1. ,  I  u  )  ,  I  »  1  ,  S"  Cl 

PD  I  STIC  3  2D  ),  Plll.S  12  (  3?n  J  ,  EPOCH  (  3?  H  ,  P  JI.S  M  32  I  )  ,  PULSP  (  3  V  n  ) 


45 


DOUHLfc  RHKCIS1U-9  1H,  lvi,sfcC,  I  hi  ,  ll' )  ,  Sf.Cl 
DOUBLE  FRLC1S10J  FFUCM , PULS* , PULSP 


DIMENSION  **  (44b  )  ,  IShCl  3  2  )  ,  I  *S(  32) 
1  N  T EGF K  *  4  HU  i  ►  , .  1 ,  v  i'i ,  s S 
1  N  fFGFrt*  4  l  H  ,  I  "  ,  Ml  ,  I  F  1 
JNTKGhR  PULS J 1 , HubS 12 


I  EOF  =  U 

REAP  REC  3RD _ _ 

J  =  0 

1  R  K  A  i)  (  9  )  *  tv 

CHECK  FOR  EOF 

CALL  fc  Xt-  C(  1  3  , a  ,  IK0151  ♦  ♦  *  *  * 

1  FU  15=1  AH)  (  I  fed  F5, 20UH)  ****** 

IFdFOrS.NK.OJ  lEOfe  =  1 
1F( IFOF.EO. 1 )  GOTO  99 

UNPACK  DA  FA 
L  J  1  2  5  *  =  1  ,  3  2 
L  =  K-l 
0  HR  =  0 

] AWG1  =  1  4  *  L* 1 
( 1 ARG1  ) 

HR*HR*t ISrtF I  (  j  ,  -  31)  )  ♦?" 

HR* HR  ♦  1 t  SHF  T  (  U  SH>  tTj  ,  1 )  Y»  - J 1  )  )*1 0 
HR=HRf(! Srtfe  I  (  <  1SHK1  (  J,2)  )  ,  -2*3  )  ) 

I  IH(K )=FLOA FIHKJ-IH1 
MN  =  0 

MNsmm+i jSrtfe T( 1  SHF  1 ( J ,b J ,-31 ) )*40 
HN»*N»(lSHrn  IShFF( J , 7) ,-3l) )*20 

M  N  =  H  N  ♦  (  I  .3  i  F  I  (  I  S  H  F  I  (  .1  ,  H  J  ,-31  J  )  *  1  U 
MNsviNf  (  1  SriFT  (  I  SHF  r  (  J  ,  9)  ,  -  31)  )  *9 
v('i  =  M<,  ♦  (  1  SHfe  r(  IS^f  t  ( .)  ,  1  0  )  ,  -  3  1  )  )  *  4 

H'.si,  M  I^Hf  I  (  1  s  tr  I  (  .1  ,  1  1  )  ,  -  <  1  )  )  *2 
*ti’«  =  *<v*  (  f  Sir  I  (  t  SHF  f  {  J,  1  2  )  ,  -31  )  )  *  1 
10  J  M  (  K  )  =  1  ■  | 

K  SEC* 0 

KSF.CsK  S  F  C  +  (  ISHFI ( ISHFi ( J, 1 3 ) ,-31  ) ) *4  0 
KSEfsKSKC*  C  I  Sip  i'C  I  SHF  I  (  J,  1  4  )  ,-31  ))*?() 
KSKC  =  KSKC+C ISHF  r( I  SHF  I  ( J,  1 S)  ,-31  )  )  *10 
KSKC  =  «  S--C  +  C  1SMFU  IbtiFI  (J,  |t»)  ,-31  ))*R 
K  SFCsKSF  C ♦  (  1  SHF  f ( I S  h F T ( J , 1 7 ) , - 9 1 ) ) *  4 
KSfcC  =  «3p;C*  (  I  SHr  I  (  I  SHfe  H  J  .  1  *3  )  ,  -  31  )  )  *2 
KSeC  =  KSFC+(  ’Sit-  I  l  ISHFi  C.J,  19)  ,-?l  )  )♦  1 
0  1SFC(*  l=*sSFC 
*35  =  n 

"S  =  .-ift+(  I  3  3  F  T  (  l  SHET  (  J  ,  20  )  31  )  )*bOO 

"SsmsM  I  SHI’  I  l  I  Sip  n  J  ,  21  )  ,  -  3 1  n  *4 tin 
*>SsMS*-(  IS*»F  i  (  1ShFP(  j,  22)  ,  -  31  )  )  *2 1»0 
tfs='i.s4  ( i  sit-  r  ( i shi-  n  j,2  ) )  ,-3i  ) )  ♦  i no 
"S*v\S*  (  I  SiF  1  (  I  SHF  l  (  J  ,  2  4  )  ,  -  31  )  1  ♦  RO 
VIS*  'SMI  SHfe  i  (  1  SHF  1  (  I  ,  IS  )  ,  -  3  1  n  »  4'  I 
<*S*»  3*  f  1  SHF  I  (  I  S-1fc  t  (  J,  ?p> )  ,-  31)  )  *20 

vS:  ‘ S ♦  (  1  Sip  I  (  1  M-F  r(J  31  )  )  «  J  t> 

*  S  a  -  S  ♦  t  *  s  *  1  f  1  *»:  i  p  I  |  l ,  / 1  )  ,  -  3 1  >l*i 

-  -  *  *  >i,i  •.iii  ,  hi. stilt*,. 


non  non  no  noon  oonon  noon  noonnn 


4 


MSsmS+(ISHFI(LSmF1(J, 31), -31)3*1 
50  I y  S ( K ) =  M  3 

SKC  (  K  )  zFl.OA  1  (  1  SEC  (  *  )  )  +  HI,  JA  r  (  J  1  \S  (  t.  )  )  /  1  (MM) ,  -3EC1 
1  w*ls  f  SHFI't  JSHF1(  ISriFl'C  *•*  <  1  4*0*3  )  ,  I  b)  -  3  0  )  ,  1  b  ) 
lr^slSHc’j'(**(H*L  +  ;),-lt>J 
bo  A Z  (  K  )=E0 MAT  (  l  JR  (  {  v.  i  ,  1 1.  2  )  ) 

I  rtw  Is  ISHf  r  (  ISfiFl  (  o  *  (  l  4*L  +  2  )  ,  1  h  )  ,  -1  N  ) 

1  ti  w?s  I SH  F  r  C  1 3H  (■  I  (  J  3  H  F  r(»MH»U3),lR),-3ti),lb) 

70  Eb  (k  )  =KL,  )A  1  (  I  OK  (  l  »v*  1  ,  1  *  t>i  )  ) 

I  .i*  1  =  I  S  H  F  1  (  a  *  (  j  '1  ♦  1 ,  ♦  3  )  ,  -  i  b  ) 

Iw*2=  I  SHK  I  (.  I  SHF  l(  1  Smk  l  (  w  «*  (  1  4  *L*  3  )  ,  20)  ,  -  30  )  ,  lb  ) 

BO  RA  (KJsF’L.OA  f  (1  )R  (  I  *  w  1 , 1 ««  2  ) )  _ 

blM(K )=I ShF  I  ( I SrtKT ( .  a  C 1 4  * 0 ♦ 3 ) , 2 3 ) , -  3 1  ) 

C  I  ANS(K  ,  9  )  - 1  SHF  I'(  ISHFl  C  * (  14*0+3  )  ,  24  )  ,-30) 

C  lANS(k,10)=lSHFT(lSHFi(»*ll4*U+3),2h),-3o) 

1R(.W(K  )=  I  SHF  1C  I  SHF "I  (  ,**  (  1  4*1,+  3  )  ,  2B  )  ,-31  ) 

ISP(K )s  ISHr  1 ( TSmF  T( » * (14*0  +  3 ) , 29 ) , -  31  ) 

IAN  SC  K ,1  3J  =  I SH  F V( J  SHF T(**(14*b+3),  in  )  ,  -  3 1  ) _ 

IANS (Or i *  3  si SH  F  f ( ISN F f ( *  * 1 1 4  *b+  3  3 , 3 1  3,-31) 

9  0  1  ANS(K  ,  1  53  =  ISHFTf  m  a  (1  <**!,♦  4)  ,  -  27  J 

IAUSCK,lb)slSHFl(lSuF,l(**ll4*L  +  4),5),-2  7) 

I  A  N  S  (  k  ,  1  7  )  s  I  S  H  F  T  (  ISHF  1'  (  *  *  C  14*  t, +  4)  ,  1  0)  ,-?l  ) 
lANS(F,1‘<)  =  lSH*-l,USHMl**(14*L  +  4),U),-3n 

bSRON  (JL)_«LSHF  rt  ISHF  1  (  w *  C  1  4*f,»4) ,  1  2  ) , -3 1) _ 

100  1  CM  P  ( K  )  s  I  SH f  n  ISHFl  ( #  a  ( 14  *L,  +  4),  13),  -  31  ) 

I  A  U TO  C  K  )  =  I  5 «  F  1  (  1 5 h  FI  (  v  iv  (  1  4  *  0  +  4  )  ,  1  4  )  ,  -  3  1) 
lANS(K,22)  =  lSHFir  TSmFUiH(14*  0+43,15), -3  J.  ) 
IAWS(k,23)  =  lSHFI(lSRFr(**U4+b  +  4),lk),-2  4) 

1AHS(K  ,  2  4  )siSHFf  (  ISHF  X  (  ■*  *  (  \  4*0  +  4)  ,  74)  ,-2?) 

110  J  A )S(K,25)sISHFT(lSRFf(w«(14*b+4) ,273  ,-27) 

'■;  =  () 

DO  125  1  =  1  ,  4 1>,5 
J=I-\ 

M  =  M  +  1 

] C=M+4 ♦ 1 4*0 

I A  NSj(  K  ,  J  +  2  6  )  =  l  S  iKT(ww  (  10,-31)  _ 

IAMStK, J+27 )sISHFP(ISHFl ( IC) , 1 )-2«) 

1  ANS  (  K  ,  J  +  2#  )  =  (  I  SHET  USnF  I  (  w  ( 1C)  ,  5)  ,  -21  )  )  *50.  OE-9 

i  a  n  s  c  k  ,  j  +  2  4  i  =  r  s  u  k  r  r  i  s  n  f  r  (  *  <■  ( i  c ) ,  i  s ) ,  -  3 1 ) 

12  0  J  I.  >S(>  ,  •  ♦  *  ■  I  )  -  (  I  >  •  (•  I  (  1  S  r<  r'  1  l  *•  *  l  I  C  )  ,  1  /  )  ,  -  1  "  J  )  *50  .  1  -  I 
125  CCJMtlf.Ot, 


w  R  I T  E  (  1  ,  1  0  1  ) 

101  F0K^A1'(5X, ‘SUBROOriNF  UOPCK  OK') 

99  RETURN 
E  N  D 

SUBROUT  l  H F  OU  TP  T  (  UP  ,  1  FOB  ,  I  PUT  ,  lPACJF. ) 


COMMON  I H (  3  2  )  ,  I  M(  32)  ,  SFCC32)  ,  AZ(  32  )  ,FI,C  32  )  ,  RA(  32  )  , 

X  LT'K  3?  3  ,  I  ROV  (32)  ,  1SRC32)  ,USRiiN(  32) ,  ICMP(  32)  ,  l  AlirO(  32  )  , 

X  XU,  VU,  Zb,  I  U 1  ,  1  1  ,  St. Cl 

X  Pi/UST  l  (  3  2')  1  ,  PULS  12  (  3‘2o),  EPOCH  f  3  20  )  ,  P  JUS  .v  (  3  20  )  ,  PUbSP  (  320  ) 

DDUHbE  PRFCISlOu  1  H  ,  1  '  ,  SEC  ,  1  H  1  ,  7  r*  1  ,  SFC1 

I  U  I  F.GFR  *  4  1  H  ,  I  ■> ,  1  il  ,  J  x  1 

X  t  PHCH,PUbS*  , PUUSP 

j  atfgfm  puusri  ,pui,si  2 

I I  I  *'  |\ ;  i I  I  I  I  r  (  l  ••)  )  ,  X  (1  »lO  )  ,  ?  !>(  1  1)0  )  ,  M  "  (  1  HU  )  ,  r  (  1  .)),()(  1  ,on  , 

X  (  (  I  I  I  I  ,  (  K, '  )  .  '  '  l  1  •  ”  I  )  ,  '  l  1  1  •  )  ,  1 1  !  '  (  I  1  I  1  ,  I  1  •  1  I  1  , 

1  ■>  1  U(  1  -i  i )  ,  .H,:  n  (  l  iiM  ,  J<  t  (  l  otn  ,,i  A  I  r  HI  »  * ) 

A  7 


DIMENSION  DC  10  0) 


C 

c 

C  dduhlf;  precision  n«t, 

REAL  JK 
C 

C  LI' Ai>  OUTPlJI  BUFFERS 

C  #  R 1  f  E  (T7 1 Q  5  ) 

C  1  Ob  F  U  K  s  ft  T  (  5  X  ,  1  •'  A  D  E  11'  1  a  1  u  SllBR  OUT  1  Dt.  UUTPT') 

C 

DO  100  1*1,32 
IPNT  a 

_ _  X(  I P  NT  )  =  AZJ[  M 

Y(IPNT)  =  E  L  (  £ ) 

ZCIP^  f )  =  * ft  (  1  ) 

J  t,  l  -i  (  ID  N  1  )  =0  1  (  I) 

JRUV ( IP ) s 1 KOV 11) 

J  S I G  (  T  P J I ) * I S  P  (  1  ) 

JLSR(  IP  v  !')=(, SK'i  (  l  ) 

JCMD(  I  p-j  1  )  =  I  C  -tp  (  1  i 
JAHTUC  I  P.M  f)sIAUTO(£) 

riME(IPVT)s(  1H(  l  )  )  *  3o(!0  .  +  ( I  ( I  )  )  *60  ,+SEG  Cl  ) 

C  *RITE(6 , 500) (EPOCrii K) , PULS'D  (K  )  ,  PULST2  (  K  )  ,  PULS  *  (  «  )  , 

C  X  PULSP(K) ,K*1 ,320) 

C  500  FORMAT ( X , F22  « 1 1 , 4C  5X , IIP) ,/,  ) 

1  F  (  1  P..  I  .  L  1 .  1  00  )  C:  U 1 U  Iff) 

1  IF(  IPM'.EO.O)  SUl'U  0  9 

C  "KITE(6,500>CX0D(K),*dU(K )7Td  D (KT,K=T,  i P~N  T ) 

500  FOR MAT( 3(5X ,613.7) ) 

C  WRI TE( 1 , 106) 

C 1  Oe>  FORMAT  (2X,  'MADE  IT  UP  TO  CALL  TO  FIT') 

"CAM.  FI  1  (H  "k  ,  X,XI) ,  XOD  ,  Y  ,  TO,  ?UD  ,  i. ,  Z07  ZlW,  I  P  71) 

C  ft  PI  JF(  h  ,  50  0  )  (  X  D  I.)  (  ft  )  ,  Y  IJUCft)  ,  2, DP  (K  )  ,  «=1  ,  IPO  D 

C  w R I T e (1 , 5  0 1  ) 

C  501  FOP/.  AT('  AFIFR  '  FiM  ',//) 

C  wKITE(6,5oO)(X(K),j(K),Z(M,Ksl,IP.MT) 

DO  2  0  .1  =  1_,  I PNJP 

CALL  ACiCCU(J)  ,  a  DC  J  )  ,  XODl'J  )  ,  Y  (  J  ) ',  YD(  J)77l'  0  (  J  )  ,  7.(1)  ,  ?.0(  J  )  ,  £’)[)(  J  )") 
C  WRITE! 1 , 1 0  7 ) 

CIO?  FOP/ft  1  (  2X  ,  1  BACK  FRO>  XYZCY') 

?  0  C  i  ^  M  '  1 1 F 

0  0  35  J  -  I , I P  * l ,  3 o 
Jft  =  o . 

xs=o. 

YS  =  0. 

zs=o. 

XV  =  o. 

YY  =  U. 

zv=o . 

Xflsu . 

Yft=0. 

Za  =  0  . 

IPAGK  =  1P«GEF1 
CALL  LAHELC  LP  ,  1  P  A  (>K  ) 

KKs.)  ♦  1  'i 

IFC  ( IPr;  r  .  b  r .  1  00  ) .  a ,m,  c  J.  ST.  50)  )k7*TP0T 
i  f  c  i  pw  r,  i.  r .  so )  *i\=  i pn  j 
00  30  <=J,KK 
JK=JK+ 1  . 

XS=  XS+X ( K  ) 

Y  S  S  Y  S  ♦  Y  (ft  ) 
l  S  =  L  *•  ♦  >■  (  ft  ) 

i  (  *  I 

i  v  s  i  v  ♦  i  C  '  ) 


48 


n  o  o 


V 


ZY  =  Zv  4ZDIK  ) 

XA  =  XA*XI)0(k  ) 

YA=YA  +  Yl)D(*) 

Z A=Z A ♦  ZuD  ( >\  ) 

NRITt(LP,o00)  I  i  *K(n  )  ,  X  (K  )  ,  Y  (  K  )  ,  Z(K  )  ,XL>(K  )  ,  YD(  <)  ,  ZO(K)  , 

X  XDD(K)  ,  YOD(K)  ,  Zl>D(K)  ,  JLIN  (K)  ,  JHOV  (K)  ,  JSIG(K)  , 

X  JLSR(K ) , JCHPCK ) , JAUTO(K) 

30  CONTI  n  JE 
XS=XS/JK 
YS=YS/JK 
ZS=ZS/ JK 

XV=XV/JK  _  _ 

YV  =  Y V/JK 

ZVaZV/JK  _ 

XAaXA/JK 
YA=YA/JK 
ZA=ZA/ JK 

3  b  WR  I  i  fc  (LP,b01  )XS,  i'S,  ZS,  X  V  ,  Y  V  ,  ZV  ,  XA  ,  YA_,_ZA _ 

601  FORMAT (/,'  MKA'iSj  '  ,  4*  ,  y(  A  ,F 10. /)  ) 

I  PM  1=0 
C******* 

C  I EOF at 

ifueof.eq.u  c;oro  yy  _ _ _ _ _ 

100  CO NTJ  HUE 

600  FORM AT ( X, F 7. 3. 3 X. 9 (X, FI  0.2) ,613) 
iFCiEOF.ea.o)  goto  yy 
1FCTPNT.NE.O)  GO  1 U  1 
yy  RETURN 

END  _ _ 

SUBti  u  U  I  1  ti  E  F 1 1‘  (  T 1  M  £  ,  X ,  X  0  , X  00 ,  Y  ,  i  0  ,  i  D  P  ,  Z  ,  Z I  > ,  1 00  ,  O’  .  f  ) 

ROUTINE  10  SMOOTH  LASER  TRACKER  DATA 


C 

bf>0 


50 

1  0 


DOUBLE  PHECLSIU.m  CX  (  103  ,CY  C  10)  ,CZ(  1  0) 

DIMENSION  X(lO0),XP(10U),XDD(lOO).Ytl00),YD(100),lfPD(l00) 
DIMENSION  Z<  1  00)  ,ZD(lo'o  j  ,ZDD(  100) 

DOUBLE  PRECISION  l']f‘E(luU) 

«  k  1  I  *■  (  b  ,  6  0  0  )  l  P  4  I  ,  (  X  n  )  ,  i  (  1  )  ,  Z  (  1  )  ,  1  =  1  ,  T  PNT  ) 
for  • -a  i  (  3  < ,  i  ,  / ,  ]  -iOi  x ,  <  ( i  i . ; ,  sx  ) ,  /  ,  n 

1  P  l»  I  ]  S  l  P  4  1  -  Q 

00  100  1=1/  1  R  1  T  1  _ _ _ _ 

IFU.GT.7)  GOrO  10 

IFCi.GT.l)  GOTO  TOO 

CALL  C  R  t/  F  i  (  rivE(  1  )/a(  t)  ,3,9,CX) 

CALL  C R  V K  1  (  T 1  F  ( I  )  ,Y(I),3,9,CY) 

CALL  CPVFK  1  I  ME(  I  )  ,Z(  I  )  ,  3,9  ,CZ) 

DO  50  Jal ,  /  _ 

CALL  K'J NCK  I  t  'K(  J  )  ,  X  (  J  )  ,  X0(  J  )  ,  XI'D(  J)  ,(’X  ) 

CALL  FUNCT  (  1  i  '•  E  (  J  )  ,  Y  (  .))  ,  YD(  J  )  ,  YI)I>(.J)  ,CY) 

CALL  FUMCTtT  I  x  n  (  J  )  ,  Zl  J)  ,  ZU(  J  )  ,  ZDI'f  J  )  ,  CZ) 

CONTINUE 
GOTO  10 0 

C  Jh  1  |  Mir:  _ _ _ _ 

C  A I  L  CRVF  1  (  TlMEC  1-6)  ,X()  -6)',3, 9,CX  ) 

CALL  CP  VC  I  C  I  I  "E(  T  -b)  ,  Y  (  I  -b)  ,  3,0  ,(’Y  ) 

call  cpxf  n  m  ( i  -*>  ) ,  /. ( i  -w ) ,  < ,  y  ,rz ) 

CALL  K’l  Cl  (  I  l  •■»(  T  )  ,  X  l  I  )  ,  XlH  1  )  ,  XUi>(  I  )  ,CX  ) 

CALL  F U n C  T  (  T 1  '  *■  (1  1  ,  1  (  I  )  /  I  D  (  I  )  ,  Y  I ) * i  (  l  1  ,CY  ) 

CALL  F'InC  f  (  I  I  •  E  (  1  )  ,  Z(  I  ),/,!>(  1  )  ,  ZI»H  I  )  ,  rz ) 

Ci  i  i  • « • 

I L  I  l  =  1  •  I  -  s 


• 1  j  n  o  i  -  j  f  1 1 ,  i 


zp 


i  i 


ooo  oonooonononno 


CALL  FU  1C  I  (  II  *t  (I  )  ,  X  (  J  )  ,  X  0  (  I  )  ,  XUL  (  I)  ,  CX  ) 

CALL  EU MCI  (  1  1  **•’  (  I  )  ,  Y  11  )  ,  KOI  1  )  ,  1  l)U(  1)  ,CY) 

CALI.  KUxCl  (  I  l'E(  1  )  ,  2  (  I  )  ,  £0(1  )  .  ZUU  C  I  )  ,CZ) 

no  continue 
k  t:  t  n  k  v 
t:  .m  u 

SUBROU FINE  C«VKT(X,Y,M,il,C) 

LEAS  ! -S'IUAkES  PULYN'OMAL  CUR  i/K  MTTlf.G  ROUTINE 
SOLVES  KOk  CUEKFIClkf  IS  ClI)  GIVEN  X-Y  PAIRS 
OK  DATA  POINTS  EUR  EQUATIONS  OK  1  H  E  KURM; 

_ _ YaC(Q+C(2)*X»C(3)»X»*2  +  .  ,«»C(M  +  I  )*X»»h 

C  =  COEKK I  Cl EN  T  A  EE  AY 
X  =  INOEPENOAn  r  VARIABLE 
Y  =  DEPENDAivi T  V  Ak  l  ABLE 
M  =  URDER  Ok  PULYnOiIAL  (10  MAX) 

N  =  f)U.  X-Y  PAIRS 


0 1  Ei  E  N  S  1 0  V  X(l0),i(10) 

DOUBLE  PRECISION  A (1  1  , 1 1 1 ,P( 1 1 ) , PC  20) , Y Y(9) ,C( l 9  ) 
DOUBLE  PRECISION  FAC  TDK , SUM , TEMP , X 


W  R  1  FF.Cb,  bftl  )y  ,N 
febl  F0KMAT(X,ib,5X,16) 

DU  1  1=1,9 

C  WRITE (6, OSS) X( 1 ) , Y( 1  )  ,C(  I  ) 

bbb  FORM AT ( X,3(E13.7, sx)  ) _ 

1  Y i ( I  )  =  Y(i) 

N  N  =  *  +•  1 
DO  b  1  =  1  ,'JM 
5  C( 1 )=0. 

C  COMPUTE  'P'  ARRAY  (POWERS  XCI)  ) 

M_X2  a  M  *  2  _ 

DO  13  1=1, M X 2 
P  ( I )  =  0 . 
on  13  j=i ,  ,4 
13  pc  i  )=i  n  )  +  *  1  J  )  ♦ ♦ i 

C  DEV  k  Li  IP  COnSIA  I  I  E  K  S  j  F  iiURMAL  EU.S. 

L  =  M  +  1 

DO  30  1  =  1,1, 

DU  3  0  J  a  1  ,  L 
K  =  I  +  J  -  2 
IE(K)29,29,28 
2  8  A ( I ,  J ) =  P ( X  ) 

GOTO  3  0  _ 

2  9  AC  1, 1 )  =  V 
30  CONTINUE 

U ( 1 ) =0 , 

DO  21  J=l,.'i 
21  B(1  )=)'(  I  I  +  YYfO) 

DO  2  2  1*2, L 
HU  )  =  0. 

DU  2  2  0=1  ,  i 

2  2  B(  I  )  =  M  (  1  )  ♦  Y  Y  ( .1  )  ♦  X  (  J  )  ♦  ♦  (  I  -  1  ) 

C  P  i  VU  i  A  L  COhDE'ISATIDw 

NMlal.,-1 

t)J  300  K  =  1  ,  OX  I 
I 

■  /S' 

1  t  i  ■  i  =  .  l  ,  i , 


o  o  o  n  onnnnnooo 


IF{DAi*j>(  A  (  l  ,*  )  A  (w*2,K  )  )  )  400,400,401 

401  ‘1X2=  I 

400  CUuiiMj*-; 

IF(MX2-K)500,500, 405 
405  00  '*10  J  =  K,L 

_ £L«P=A(K,J)  _  _ 

A  (  K  ,  J)  *  A  (  *  X  /  ,  J  ) 

410  A  (  M  X  2  ,  J  )  =  I  E  P 
r  E  H  P  s  B  c  K  ) 

MK  )=B(  -I  A  2  ) 

B ( MX  V )  =  IE  ' P 

C  ELIMINATION  AMO  HACK  SUMf  IPM  _ 

500  00  300  I=KP1  ,  L 

FAC  I'OWs  A  U,K)/A(K,K) 

A(I,K)=0. 

l)J  301  J=<P1,L 

301  A( 1 , J )3A ( f,J)-FACTOR*A(K,J) 

300  B  (  I  )  ='•  (  I  )  -f  AC rOR *  8  (  K  ) 

C ( L ) =M ( b ) / A ( b , b ) 
l«NMJ 

710  IPI=I+1 

SUMsO, 

DO  7  00  jsl PI  ,  L 
700  SUMsSUMtACT , J J*C( J) 

C(I)b(B(13-SUm)/A(1,IJ 


I F ( I )  800,800,710 
8  0  0  C  0  N  T  T  N'.l  F 
RE  j’URo 
END 

SUBROU t I N 6  F JnC f ( 11 -i , X , AO , XOD , C)  . 

D0UHL.K  PRECIS  TO  i  C  (  4  ) 

DOU 0 LE  PRECISION  11  ME 
C  WP l TE ( h , 1 00  )  (  C ( «  )  , K  = I  ,  4  ) 

100  FORM  a  T  (  1  5X  ,  j  C  f  1  3  ,  7,3X1,  '  *  *  *  '  ) 

c  x=C(ii  +  C  ( 2 )  *  f  J  "*  t  4C(3i*rive:**2  +c(  i  j  *timf**3 

Xs(  (C(4  )  ♦  l  [-’.F.  +  C(  3  )  )  4  ri  xr  +  C12  )  )  *  IMtfCC  1  ) 

C  X0=C(?)  +  7.  *C(  3  1  M  1,-:K  4  3  .  *  C  (  4  )  ♦  1  J  *■!  F  ♦  *  2 

X  D  r  (  3  .  *  r  (  i  )  *  I  I  »  ►  f  i  .  ♦  (  (  3  »  )  ♦  T  T  • :  I-  ♦  C  (  7  ) 

X  . i '  s  /  ,  *  C  1  3  J  ♦*>»4C(«)*ll'E 
KETUh.j 
_ END 

SUBKOUTI  3E  X12CV(X,XD,XDO,y,  YD,  YDI),Z,ZD,ZDD) 


ROUTINE  ID  CONVERT  TO  RANGE  CO-ORDINATE  SYSTEM 


XLX,ybr,ZbJ'  =  IRACkkR  CO-URPS. 
XL , XL , Zb  =  LAD  "CHEW  CO-URDS. 


CO v HOW  IH(  37  )  ,  iv,  f  }>:>  ,S£CC  3/1  ,  AZl  3?)  ,  EM  3?)  ,  RA(  32  )  , 

X  1. 1  M(  32  )  ,  1  R,m  3  2)  ,  ISPC  3?)  ,  LSRn.'l  (  32)  ,  1CMP(  32  )  ,  1  AUTU(  32  )  , 

X  XL,  i  L,  Ml,  f  M  1  ,  1  M  1  ,  Sfc.C ! 

DOUBLE  PRECISION  IH, Im,SEC, INI , IM1 ,SEC1 
l»‘TEGF.R*<*  14, 1  •  ,  (Ml  ,  I  *il 

trac km  c  )-i  -< 

xi.:  =  i  i  >  .  i  '  > 

V I.  t  =  -  <•  i 


L L  r  =  ?  i  .  H  8  5 

c  i' h y  range  cojmds  fok  launcher  ( xo,  yl,zl) 

XL  =  0. 

YL  =  <>. 

7.1,  =  0. 

£4******44444444444444444444444444**44444***44 

c 

C  COMPUTE  POS.  OF  PiUJf:  D  (  X  ,  If  ,  Z  ) 

C 

C  *iRITE(6, 600)X, Y ,Z 

_C  bOO  FORMAT (  3 (  IX , El  4. 7 ) ) _ 

3f=x  * .  ol  T4b  yit  ■* 

is  **.01754329  _ 

XOBXD*.Ot 754 J29 
YD=  YD*. 01 754  J29 
XDDsXL)0»,01  7  54  329 
YDD  =  YOD* .01 754 379 
"xs  =  xl r-xL T+T*  C'OslTT?  COS<  XI 

YMaYLT-YL+Z*  COS(Y)*  SIn(X)  _ _ 

ZMsZLT-ZLEZ*  SIM(Y) 

C******4**4SfARI  THE1RS**44*4444*44***** 

c 

C  DETERMINE  VELOCITIES  _ _ 

C 

VR  =  ZO 

VAZ=Z*<0*  CUS(Y) 

V  E I ,  =  Z  *  Y  I) 

c 

C  veto  IN  LAUNCHER-CENTERED  SYS 

C  “ 

VX=vW*  COS(X)*  COS  (Y)-VAZ*  SIN(X)-VEI,*  CDSCX)*  StJCY) 

VY  =  VP4  S  I  l  (  X  )  ♦  CUS(Y Ai*  CUS(X)-VE1j*  S 1  M  (  <  )  *  stun 
VZ=VR4  SliOI  +  VEL*  C'JSCYJ  * 

c 

C  COMPUTE  ACCELS,  _  _ _ _ 

C 

ARbZDO-Z*  YD**2-Z*X0**2* (  COS (  Y  )  )  *  *  ? 

A  AZ  =  (  t*  XU  0  4  7  ♦  x  H4  7.0  )  *  C  JS  (  J  )  - 

>  /  .  *  ♦  A  I  •  4  >1  (  1  )  4  V  >  • 

aFL  =  Z* < Out  7 . 4  iu*ZO+Z*  CUM  Y  )  *  X  n  4  *  2 

C 

C  CONVERT  T:i  CWSCHER  CO-OkdS. 

C 

A  X  =  A  h  *  C0S(X)4  COS(Y)-AAZ*  SIu(X)-AKL*  CUS(X)*  SI  4  C  Y  3 
A  Y  =  A  R  4  SIJ(X)*  CJSCY7+AAZ4  CUS(X)-AEL*  SIMX)*  S  l  I  ( Y  ) 

A  7, 1  =  A  R  *  SI.  (YJ+A-L*  CUS(Y) 

X  =  X  M _  _  _ _ _ _ _ _ _ _ 

Y  =  Y  M 

z-z*> 

X  D  =  V  X 
y  (»=  v  y 
7.0  =  VZ 

XDDsAX  _ _ _ 

i j  DBA  i 
Z  D  0  =  A  Z  1 

C*  4  4  *4  *4  4  4  4  4  4  *Er‘0  IMFIKS,  SIAM  I  M  J  !  i  4.  ♦  4  4  4  4  *  4  *  4  *  *  4  4  4  4  4  4  4  4  4 

C  V  K  =20 

C  V  A  Z  =  X  IJ 

C  V  El,=  Y  lj 

c  )  ,  =  V  -4  ’*  t  -V  (  »  )  4  r'  '  ~  f  A  )  -  /  ‘  V  •  >  *  X  I  (  »  )  *  C 'I  '  (  >  )  -  /  •  V  <\  7.  4  ?  I  .  f  j  |  *  S  I  '  <  X  ) 

c  i  :,m."  isf  n*  n  («)-*.  i  ♦  i  i  ■  )  ♦  /  *  j  v , .  ♦  i.  i ;  c  i  )  *  c  ■  >  t  >  i 

C  =  V  (•  *  .  l  .  I  I  i  ♦ ,/.  *  .  - .  *  l  (  I  ) 


c  o 


c 

c 

c 

c 

C  X 

C  X 

C  X 

c 

C  X 

C  X 

c  x 

c 

c 

c 

c 

c* ♦ * ♦ * 

c 

c  eoi 


ft  H  -  Z 1 1 0 
A  AZ=XI>0 
AEL  =  YOO 

XD»S(  A  *<•/.«(  VEL**7*VAZ*»2))*CiJ5(Y  j*Cns(  X) 

♦  (**R-2.*x><*ve.l.)*Slw(*)*CJS(X) 
+CZ*AAi-2.*vw*VAZ)*CUS(Y)*SIH(X) 

-  2  .  ♦  Z  ♦  v  h  ij  ♦  v  ft  L  *  S  (  .  (  r  )  *  S  I  j  (  X  ) 

i  l'f)=  (  Ar-Z  ♦  V  AZ*  *2  )  ♦  C  u  S  (  <  )  *S  J  i  (X  ) 

- ( ¥  R  *  V  *  L*  2 . ♦ i ♦ V  EL *  V  A  Z ) ♦ S 1  < ( Y ) *  CHS ( X  ) 

♦  (  2  .  ♦  VR  *  Y  A  Z-Z«  (  VEL»*  2-uAZ)  )  ♦COS(  Y  )  *Cl'S(  X  ) 
-(VR*VEL4Z*Ae.L;*SI’.(Y)*SlMX) 

ZDi's  (  A^-Z*  Yp.u*  *2  )  *S1  >v'  C  Y  J  ♦  l  2  .  ♦  Vk*  VtL  +  Z^AEL  )  ♦COS(  Y  ) 
A  =  X  •< 

y  =  Y  m 

Z  =  Z* 

♦*♦***♦♦£ mD  Mfi  E  »♦♦♦♦*♦♦♦♦♦*♦**♦*****¥** 

».  R  1 T  K  (  b  ,  h  0 1  )  X  r  Y  ,  Z 
FORMA  r(3(iX,EH,7)>/) 

RETURN 
E  N  l) 

SUBROU  r  (  NE  LAbEL(LP,  I  PAGE! 


ROUTINE  TO  PRINT  OATA  PAGE  LABEL  X  PG.  » 


npacf;  =  I P A 6 E  -1 
*R1  l'KC  LP,  1  OU  )  JP4GF. 

E  (J  H  M  A  T  (  1  H  1  ,  S  ?  X  ,  '  L  A  *»  P  A  *  S  -  LASER  '1  PACKER'  ,  1  9  X  ,  'PAGE:  ',14,//, 

_  3  X  ,  '  r  f  v  F. '  ,  1  /A,  'PUS!  i  I  ON*  ,  24X  ,  '  VELOCITY  '  ,  2  3  X  ,  '  ACCELERATION*  , 

1  b  A  , ' STATUS' , / , 

3X,  '  (SEC  )  '  ,  1UX,  '  ((■  n  '  ,  2bX  ,  '  (FT/. SEC)  '  ,2JX  ,  '  (ET/SEC-SEC)  '  ,  /, 
17X,  «  X*  ,  IDA  ,  '  Y  '  ,  10X,  '  Z*  ,  1UX  ,  'X  '  ,  10X,  '  Y  *  ,  10X,  ’?,»  ,  1<)X, 

'  X  '  ,  1  ox  ,  '  i  '  ,  I  t-X  ,  '  Z  '  ,  SX,  '  LM  nv  SP  UM  CP  AT',/, 

3  X  ,  ' - '  ,R(«X,  J,3X,b(  '  --'),/) 

RETURN  _  _  _ _ _ 

END 


SBEND 
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IIS  ARMY  M  ISSLE  RESEARCH  AND  DEVEDPMENT  COMMAND 
TECHNOLOGY  I.AHJRATOHY 

_ S  Y  ST  E MS  SIMULATION  DIKEC TOR ATE _ 

SYSTEMS  EVALJATlOo 


LAMPAMS  -  LASER  TRACKER 


TIME 

POS1 l ION 

VELOCITY 

(SEC) 

X 

( E  T ) 

Y 

Z 

X 

(FT/SEC) 

Y 

Z 

— 

“  * 

m  m  m 

•*  *  • 

•  •  ™ 

0.2  SO 

1  067  .  S7 

269.27 

25.45 

58.11 

-47.44 

43.47 

0.260 

1  <J  6  8  .  S  1 

26b , Sb 

26.08 

36.42 

-24.50 

20.1  H 

0.270 

1069.06 

258.2b 

26.  30 

19.13 

-6.59 

2.8  2 

o.  280 

1  064. 29 

25b . 26 

26.23 

4.72 

6.28 

-*.64 

0,290 

1 069 ,27 

258.47 

2  5.90 

-  6 , 3  2 

11.10 

-1  1.10 

0.300 

1069,06 

258.79 

2  5.70 

-1 3. 99 

16.87 

-  1  3,83 

0.310 

1066.74 

259.12 

2  6,48 

-18,39 

14.58 

-  /  .  57 

0.3  20 

1068,2/ 

259.51 

2  5.45 

-6.47 

5.34 

5.12 

0,330 

1068.3b 

259.30 

V5.7h 

b  .  0  8 

-9.46 

14.32 

0.340 

1  0  6  8 . 7  6 

258.94 

PO 

J 

• 

NJ 

n; 

10.06 

-7.65 

15.49 

0.3S0 

1069.09 

258.66 

26.54 

6.14 

-4.14 

/  ,  06 

0.360 

1069. 1 1 

2  5  6 , 8  4 

26.65 

-2.11 

-1.78 

—  3.58 

0.370 

1  0  n  6  .  8  S 

2  5  8 . 6  6 

26./) 

-7.1/ 

1  .68 

-10. S3 

11 .  3i<  0 

1  •  6  i  .  >  1 

2  5  <•  ,  9  7 

2  5.8  6 

-H.  )  5 

4.64 

-  3  .  ->  1 

0.3?  0 

1  1  6  .  t  o 

259.06 

2  6.72 

0.64 

4.05 

-3.85 

0.4  00 

1 066.66 

25y.i  17 

2  6  .  #  / 

/  ,  S  >-t 

11.49 

1.68 

0.4)0 

1 068,98 

25m.  3  / 

26.00 

9  ,  -M 

-5.46 

4.2  5 

0.4?0 

1069.22 

2  5  9 . 2  3 

2  6.11 

6.90 

4.20 

2.54 

0.430 

1069,20 

259.08 

2  6.10 

-4.95 

-7.88 

-3.94 

0 , 44  0 

1  0  o  8 . 4  2 

269.15 

2  6.90 

-11  .  )8 

2.78 

-  /  .  2  5 

0.4, so 

10  6-1.55 

258.96 

25.66 

-11.65 

1  1  .  33 

-  /  .  1  6 

0.460 

t 069. 32 

259,64 

26.64 

-5.93 

2.64 

-3.51 

0.470 

1068. 37 

259.59 

25.57 

4.61 

-1.34 

0.50 

0 . 4  b  0 

1 06b , 66 

259. 34 

2  5.67 

12.49 

-13.07 

3.18 

Note  That  target  acceleration 

and  LAMPAMS 

status 

report  have  not 

been  presented  but  are  normally  included  in  the  output. 
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1  ) 
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)  *>3 

31)  )  *4 

*  1 
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31 

)  )♦  1 

3) 

,-31 ) )*40 

4  ) 

,-31)) *20 

s) 

,-31))* 10 

n) 

,-31 ) ) *« 

7  ) 

,  -  3  1  )  )  *  4 

rt  ) 

,  -  3 1  )  )  *  ? 

■3) 

,  -  3  1  )  )  *  1 

>  1 

)  )  *1-011 

31 

)  )  *4  031 

31 

)  ) *3  HO 

3  1 

) ) * l on 

31 

)  )*Kl> 

3 1 

)  1  *40 

3 1 

)  )  *20 

3 1 

))*!•» 

« 1 

)  )  •  .i 

'  3  1 

M  *  -* 

'  .1 1 

)  1  ♦  t 

A 

y 


